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SYNOPSIS 


Wheeled systems are energy efficient on prepared surfaces like roads and tracks. 
Legged systems are capable of traversing different terrains but can be lossy. At low 
speeds and on off-road surfaces, legged systems using dynamic walking can be efficient. 
Towards this objective, the dynamics of the walker needs to be modelled and controlled. 
This thesis presents analysis and experiments on the dynamics and control of a rimless 
wheel based mobile robot (Chatur) in a category between wheeled and legged systems. 
It is effectively a 2D dynamic walker that serves as a platform for investigating inverted 
pendulum walking. A pulsed actuation torque is proposed for the system resulting in four 
torque regimes defined by the ratio of energy losses to available actuator torque. Five 
physical constraints that limit the choice of operating points of a generic inverted pendu- 
lum walker are expounded and location of optimal operating points is discussed. Chatur’s 
hardware design is elaborated and a control topology is proposed for pulsed actuation of 
the dual brushless de (BLDC) motor driven platform with wheel synchronization. 


A closed-form analytical solution, using hyperbolic functions, is proposed for the 
stance phase inverted pendulum dynamics. Suitable models for ground impact and brak- 
ing losses are used. There are four types of sub-phases within a stance phase — actuated 
rise, unactuated rise, actuated fall, unactuated fall. These are concatenated in four dif- 
ferent ways to form repeating cycles yielding the four torque regimes that are identified 
by the fraction of stance phase for which the actuator is energized. The experimental 
set-up is a fixed step-angle walker built using two adjacent rimless wheels independently 
actuated at the hub. Varying the magnitude and duty ratio of the torque pulse, the pro- 
posed regimes are experimentally shown. The mechanical cost of transport is computed 
for different speeds. Videos of the walks are also taken. 


The operating point of an inverted pendulum walker can be specified by the combi- 
nation of initial mid-stance velocity and step angle chosen for a given walk. Using basic 
mechanics, a framework of physical constraints that defines allowable operating points 
is presented. For any given speed, the optimal operating point with minimum mechani- 
cal power requirement is located based on tangency of the power and velocity contours. 
Repeating for different speeds, a family of optimal operating points, called the optimal 
locus, is obtained. Using an appropriate constant step angle over a range of speeds could 
lead to an inverted pendulum walker that is close to optimal. 


The hardware design for Chatur and the caveats associated with reliable performance 
of its mechanical and electrical subsystems are elaborated. In order to ensure lateral 
stability, the system uses two contralateral wheels driven by separate BLDC hub motors. 
From a motor drive perspective, the reflected load torque has a characteristic cyclic 
variation that repeats several times within a mechanical revolution. The proposed control 
topology has two hierarchical levels, an inner loop for torque control of BLDC motor 
implemented using a standard proportional-integral controller, and an outer loop for 
torque reference generation that uses the information on the ground impact instants 
and the motor position feedback. Ground impacts of the spokes are detected by an 
accelerometer to initiate the application of torque. Wheel synchronization is achieved 
by incrementing the torque of the motor that is lagging. The BLDC motor drive uses 
non-commutating current feedback to reduce current spikes during sector transitions. 
Experimental waveforms for controller validation are shown. 
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Abstract 


Wheeled systems are energy efficient on prepared surfaces like roads and tracks. Legged 
systems are capable of traversing different terrains but can be lossy. At low speeds 
and on off-road surfaces, legged systems using dynamic walking can be energy efficient. 
Towards this objective, the dynamics of the walker needs to be modelled and controlled. 
In addition, the braking and ground impact losses need to be minimized. This thesis 
presents analysis and experiments on the dynamics and control of a rimless-spoked-wheel 
based mobile robot (Chatur*) that belongs to a category between wheeled and legged 
systems. This rolling rimless wheel is effectively a 2D dynamic walker that serves as 
a platform for investigating the dynamics and energetics of inverted pendulum walking 
with constant step angle. A pulsed actuation torque is proposed for the system resulting 
in four torque regimes defined by the ratio of energy losses to available actuator torque. 
Five physical constraints that impose fundamental limits on the choice of operating points 
of a generic inverted pendulum walker are expounded and a method for locating optimal 
operating points is discussed. Chatur’s hardware design is elaborated and a control 
topology is proposed for pulsed actuation of the dual brushless de (BLDC) motor driven 
platform with wheel synchronization. 


Various actuator torque profiles can be used to achieve dynamic ‘walking’ in a hub- 
actuated rimless wheel. The proposed pulsed actuation torque gives rise to four torque 
regimes that achieve sustained walking and a fifth regime where the walker keeps slowing 
down with each step. The regimes can be identified based on the fraction of stance 
phase for which the actuator is energized. Theoretical analysis and experimental results 
are presented. A simple closed-form analytical solution, using hyperbolic functions, is 
proposed for the stance phase inverted pendulum dynamics considering planar motion. 
Ground impacts are assumed to cause abrupt drop in velocity. A constant braking torque 
that lumps together the effect of several loss phenomena is also considered. Based on 
whether the CoM is rising or falling and whether or not there is an actuating torque, a 
stance phase can have four types of sub-phases — actuated rise, unactuated rise, actuated 
fall, unactuated fall. These are concatenated in four different ways to form repeating 
cycles yielding the four regimes. The experimental set-up is a fixed step-angle walker 
constructed using two synchronized adjacent rimless wheels independently actuated at the 
hub. Varying the magnitude and duty ratio of the torque pulse, the four proposed regimes 
are experimentally shown. The mechanical power consumption and cost of transport are 
computed from measured motor currents for different average forward speeds. Videos of 
the walks are also taken. 


*means clever in Hindi 


x 


The space of operating points for an inverted pendulum based bipedal dynamic walker 
in terms of constraints and optimality is investigated. The operating point of the walker 
can be specified by the combination of initial mid-stance velocity (vo) and step angle (dm) 
chosen for a given walk. Not all operating points lead to a realizable steady-state gait. 
Using basic mechanics, a framework of physical constraints that limit the choice of oper- 
ating points is proposed. The constraint lines thus obtained delimit the valid region of 
operation of the walker in the vp-¢m plane. Within this allowable region, sub-regions that 
result in various regimes of walking are identified. A given average forward velocity vz,avg 
can be achieved by several combinations of vp and ¢». Only one of these combinations 
results in the minimum mechanical power consumption and can be considered the opti- 
mum operating point for the given vz,ayg- A method is proposed for obtaining this optimal 
operating point based on tangency of the power and velocity contours. Putting together 
all such operating points for various Uz,avg, a family of optimum operating points, called 
the optimal locus, is obtained. For the energy loss and internal energy models chosen, 
the optimal locus obtained has a largely constant step angle with increasing speed but 
tapers off at non-dimensional speeds close to unity. Thus, choosing the right step angle 
and keeping it fixed over a broad range of speeds could lead to an inverted pendulum 
walker that is close to optimal from a mechanical energy perspective. 


The complete hardware design for Chatur and the caveats associated with reliable 
performance of the mechanical and electrical subsystems are elaborated. In order to en- 
sure lateral stability, the system uses two contralateral wheels each driven by a separate 
BLDC hub motor. From a motor drive perspective, the mechanical load belongs to a 
unique class of dynamic loads whose reflected torque has a characteristic cyclic varia- 
tion that repeats several times within a mechanical revolution. The proposed control 
topology has two hierarchical levels, an inner loop for torque control of BLDC motor im- 
plemented using a standard proportional-integral controller, and an outer loop for torque 
reference generation that uses the information on the ground impact instants and the 
motor position feedback. Ground impacts of the spokes are detected by an accelerometer 
to initiate the application of torque. The torque pulse magnitude can be set internally 
or by a manual operator via radio control. The pulse duration is programmable and 
enables attainment of various torque regimes at different steady state speeds. The wheels 
are synchronized so that corresponding spokes on both wheels move in unison. This is 
achieved by including a wheel synchronization loop that compensates for any lag between 
the wheels. Lag is detected based on number of sector changes in the hall-effect position 
sensor data received from both motors. An improved BLDC motor drive is developed 
wherein non-commutating current feedback is used to reduce current spikes during sector 
transitions. Experimental waveforms for controller validation are shown. 
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Sub-phase duration 

CoM velocity 

Initial mid-stance CoM velocity 

Mid-stance CoM velocity at steady state 
Initial condition (for a given sub-phase) of CoM velocity 
Pre-impact CoM velocity 

Post-impact CoM velocity 

Quantity (/gl) used for normalizing velocities 
Average forward velocity 

Horizontal component of CoM velocity 

DC link voltage of inverter 


Weight of the locomotor 


List of Abbreviations 


Acronym Description 


2D 

3D 
ADC 
AF 
AR 
ASK 
BLDC 
CAD 
CCW 
chan 
CIPOS™ 
CoM 
CoT 
CW 
DAC 
DMA 
DoF 
EMA 
EMF 
GRF 
IGBT 
LED 
LIPM 
MEMS 
MOSFET 
MS 


Two Dimensional 

Three Dimensional 

Analog-to-Digital Converter 

Actuated Fall (of CoM) 

Actuated Rise (of CoM) 

Amplitude Shift Keying 

Brushless Direct Current (motor) 

Computer Aided Design 

Counter Clockwise 

channel select (of analog multiplexer at ADC input) 
COntrol Integrated POwer System (from Infineon) 
Center of Mass 

Cost of Transport 

Clockwise 

Digital-to-Analog Converter 

Direct Memory Access 

Degree of Freedom 

Exponential Moving Average (digital filter) 
Electromotive Force 

Ground Reaction Force 

Insulated Gate Bipolar Transistor 

Light Emitting Diode 

Linear Inverted Pendulum Model 
Micro-Electro-Mechanical System 

Metal Oxide Semiconductor Field Effect Transistor 
Mild Steel 


XXV 


XXV1 


Acronym Description 


Mux 
PCB 
lea 
PSoC® 
PWM 
R1 

R2 

R3 

R4 

R5 
RF 
RPM 
RX 
SAR 
SLIP 
soc 
SWG 
TX 
UART 
UF 
UR 
wheg 
ZMP 


Multiplexer 

Printed Circuit Board 

Proportional-Integral (controller) 
Programmable System on Chip (from Cypress Semiconductor) 
Pulse Width Modulation 

Regime 1 

Regime 2 

Regime 3 

Regime 4 

Regime 5 

Radio frequency 

Revolutions Per Minute 

Receiver 

Successive Approximation Register (type of ADC) 
Spring Loaded Inverted Pendulum 
start-of-conversion (of ADC) 

Standard Wire Gauge 

Transmitter 

Universal Asynchronous Receiver Transmitter 
Unactuated fall (of CoM) 

Unactuated rise (of CoM) 

wheel + leg 


Zero Moment Point 


Chapter 1 


Introduction 


1.1 Terrestrial locomotion alternatives 


Animals, man-made vehicles and mobile robots move about in their environment — 
land, water and air — in myriad different ways. In the animal world, motion on land i.e. 
terrestrial locomotion is largely achieved using appendages such as legs driven by muscles 
acting as motors. Limbs facilitate great versatility of activities in animals. For instance, 
with the same set of limbs humans can hold, lift, catch, manipulate, crawl, walk, jog, 
run, hop, skip, jump, climb, swim, brachiate and what not. Among all these capabilities, 
picking out just those relating to locomotion still leaves a wide spectrum of capabilities 
that enables traversal of different kinds of terrains. Legged robots are only beginning to 


mimic a few of the versatile locomotion capabilities of land animals. 


In the man-made world, an overwhelming majority of terrestrial vehicles and many 
mobile robots move using wheels on prepared surfaces because of its low energetic cost 


of transport. Wheeled systems are energy efficient under three assumptions. 


1. The aerodynamic drag of the system is either negligible or minimized by design. 
2. The wheel is rigid. 
3. The surface of travel is hard and even (such as roads and tracks). 

Assumptions (2) and (3) ensure minimal deformation of the wheel or the surface of 


travel and hence a low rolling resistance. Table 1.1 shows the orders of magnitude of 


the coefficient of rolling resistance for a few common pairs of surfaces. Note that rolling 
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Table 1.1: Coefficient of rolling resistance for some common pairs of surfaces (Clark and 
Dodge, 1979; Lawyer, 2004; Coutermarsh, 2007) 


Pair of surfaces Coefficient of rolling resistance 


[ly = (drag force) /(normal reaction) 


Steel wheels on steel rails ~0.001 
Car tyre on tar/asphalt road ~0.01 
Car tyre on loose sand ~0.1 


resistance of car tyres on tar road is an order of magnitude higher than that for steel 
wheels on steel rails. Car tyre on loose sand is another order of magnitude worse. If tyre 
pressure is low or the surface of travel is soft and/or uneven leading to a poor coefficient 
of rolling resistance, use of wheels could be an energetically costly solution and, in some 
cases, not even a solution (tyres can skid in place; obstacles can be higher than wheel 
radius). In such cases, it might be better to resort to legged locomotion even in man- 
made systems. But legged systems are harder to construct and control. So they tend to 


be more expensive than wheeled systems. 


1.2 Energetics of locomotion 


For any means of locomotion, whatever is in motion can be referred to as the locomotor 
— animal, vehicle, robot. The complete energy budget of any mode of locomotion is 


shown in Figure 1.1 and is formulated by 
Etotal ae Sey + ext te oy (1.1) 


where Fn, is invested energy, Ee. is external energy and Ej, is internal energy. 


Einy iS energy invested in building and maintaining the locomotor and any other 
support infrastructure that it needs (holds for man-made locomotors only). Most of this 
energy is put in at the beginning of the life time of the system with periodic maintenance 
top-ups once in few months or years. Unlike wheeled vehicles, legged vehicles/robots do 
not need prepared surfaces such as roads or tracks. Hence, the invested energy in legged 


systems is lower compared to wheeled systems. 


Consider locomotion on level ground where the center of mass (CoM) of the locomotor 


does not have to be continuously raised (or lowered). External energy (F..+) is the energy 
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Once per lifetime 


total = ested ia Textepnal 


Once per walk Continuous 


Figure 1.1: Energy budget in locomotion. 


required to move the CoM with respect to its surroundings. It comprises two parts — 


initial energy (Fini) and energy losses (Ejoss). 
Fost _ fem: = Eis (1.2) 


For a legged system, at the start of a walk/run, some initial energy needs to be expended 
to raise and accelerate the CoM. This energy is put in only once per steady-state walk/run. 
A wheeled vehicle has a fixed CoM height above the surface of travel. The initial energy 
serves only to accelerate the vehicle to the desired speed. This is required once per stretch 
of constant speed travel. Ejos, is the energy expended to overcome losses in the system. 
Braking, ground impacts and aerodynamic drag are the loss mechanisms in a legged 


system. For a wheeled vehicle, losses are due to rolling resistance and aerodynamic drag. 


Internal energy (Fijn;) is the energy required to move the parts of a locomotor with 
respect to its CoM. Since the legs or wheels of a locomotor are much lighter than the 
full locomotor, the effect of Ein is appreciable only at higher speeds. Ejos; and Fint 
components need to be supplied continuously (Eon) in order to maintain a steady average 
speed. 

oni = Equis + Lire (1.3) 


The widely used dimensionless metric for comparing the energy efficiency of various modes 
of transport is specific resistance. It is also referred to as cost of transport (CoT) and is 


defined as 
Eo cas _ i cont 


Wd Wo 
where W is the weight of the locomotor, d is the distance of travel and Pion, is the 


CoT = (1.4) 


power that needs to be continuously delivered to the locomotor to achieve motion at a 


1.2. Energetics of locomotion 4 


constant velocity v. Note that CoT is not a fixed value for any mode of transport. It 
increases with speed. Gabrielli and von Karman (1950) collated and plotted data on the 
specific resistance of various vehicles operating at a range of speeds. They used gross 
vehicle weight in their calculations. What needs to be transported is only the payload. 
Radtke (2008) uses the payload weight in his somewhat modified metric which he called 
thermal energetic economy. Tucker (1970, 1975) analyzed the energetic cost of transport 


for animals. 


Figure 1.2 illustrates the energy flow in locomotion. The mechanical load is the body 
of the locomotor which has some inherent dynamics and loss mechanisms. It is driven 
by an actuator whose efficiency is high only in a given range of speeds and tapers off at 


higher and lower speeds. 


The structure and function of animal bodies are solutions to optimization problems 
that involve multiple competing objectives — finding food and mates, escaping predation, 
defending territory and offsprings, and surviving harsh conditions. The muscles have a 
certain design that helps meet many of these challenges. Given this particular kind of 
actuator (muscle), animals try to choose gaits that minimize metabolic energy spent for 
any given speed (Minetti and Alexander, 1997). Srinivasan (2011) details the structure 
of gaits that minimize metabolic energy for a number of simple biped models. Any 
such optimization taking metabolic energy as the cost function involves an appropriate 
energetic model of the muscle. Note that a choice of gait does not necessarily guarantee 


minimum mechanical energy for the given speed. 


As opposed to an animal, an artificial system can be optimized for any one criterion 
(if so desired), say energy. Hence, an engineer can construct and operate locomotors 
choosing gaits that minimize mechanical energy. Subsequently, based on the range of 
speeds of the mechanical load, an actuator can be designed that is most efficient in that 
range. This in turn will lead to the minimum energy input to the actuator. This approach 


is also useful while designing exo-skeletons for humans. 
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Figure 1.2: Energy flow in locomotion. 


1.3. Gaits in legged locomotion 


1.3.1 Definition of gait 


Legged locomotion, whether in natural or artificial systems, can take on various possible 
forms or foot-fall patterns referred to as gaits. Humans walk at low speed and run at 
higher speed. Horses walk at low speed, trot at intermediate speed and gallop at higher 
speed. Alexander (1989) defined gait as “a pattern of locomotion characteristic of a lim- 
ited range of speeds described by quantities of which one or more change discontinuously 


at transition to other gaits.” 


In the legged locomotion context, these quantities are duty factor (fraction of the 
stride duration for which a given foot is on the ground) and shape factor (ratio of Fourier 
coefficients describing the vertical ground reaction force acting on the foot; see Section 
1.3.3). Alexander showed that for adult humans, the duty factor in walking is above 0.5, 
typically in the range 0.55—0.70. For running it is below 0.5, typically in the range 0.3— 
0.4. The changeover happens abruptly at around 2 m/s. Similarly, the shape factor also 
abruptly changes from positive values (0.2—0.8) in walking to negative values (—0.2-0) in 


running. 


1.3.2 Classification of gaits 


Various types of gaits (Figure 1.3) have been identified and studied in nature and sub- 
sequently mimicked in artificial systems. Some gaits are seen only in animals and some 
only in artificial systems. Gaits are classified into two broad categories — ballistic gaits 


and walking gaits. 


Ballistic or running gaits have an air-borne phase when none of the legs are touching 
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Figure 1.3: Gaits in legged locomotion. E, = Kinetic energy, E, = Potential energy. 


the ground. In such gaits, the CoM trajectory resembles that of a bouncing ball and elastic 
strain energy plays a significant role. Kinetic energy (£;) and gravitational potential 
energy (£,) rise and fall in phase. Such gaits are used for travelling at high speed. 
In bipeds, ballistic gaits include jog, run, hop (on one leg) and jump (on both legs). 
Humans, birds and kangaroos exhibit biped ballistic gaits. Raibert built planar as well 
as 3D hopping and running robots having one, two and four legs (Raibert, 1986a,b). In 
quadrupeds, ballistic gaits include trot, pace, bound, gallop, canter and pronk. Several 
mammals — horses, deer, cats, dogs etc. — exhibit many of these gaits. Boston Dynamics 
built quadruped runners such as WildCat and Cheetah capable of galloping and bounding. 


Ballistic gaits are not addressed in this thesis. 


In walking gaits, at least one leg is on the ground at all times. At no point of time 
is the walker completely air-borne. Generally, little energy gets stored as elastic strain 
energy. Such gaits are used for moving at low speed. They are further classified into static, 
Zero Moment Point (ZMP) based and dynamic walking. In static as well as ZMP-based 
walking, the CoM is largely maintained at a constant height leading to little variation 
in E,. E, may or may not vary depending on the way the actuators are energized. In 
dynamic walking, E, and E;, vary out of phase with one another. A brief discussion and 
literature review on each of these types of walking is given below. Table 1.2 compares 


the three types of walking. 
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Table 1.2: Comparison of the three types of walking. 


Static ZMP-based Dynamic 


Stability High Low Intermediate 
(static stability) (static stability) (orbital/cyclic stability) 


CoM position Low Intermediate High 
Posture Sprawling Upright Upright 

(bent knees) (extended knees) 
No. of legs 4 or more 2 2 and 4 
Energy High High Low 
required 
Terrain Uneven Even Intermediate 
Foot type Point Flat Any 
Appearance Natural Unnatural Natural 
Control Conservative Conservative Optimistic 
approach (hardly any (controller damps (controller utilizes 


natural dynamics) natural dynamics) natural dynamics) 


Speed Slow Slow Fast 


Static walking 


In static walking, the system is always statically stable i.e. projection of the system’s 
CoM on the ground always lies within the support polygon formed by the feet that are 
resting on the ground. At any instant, the walker is like a table or a tripod. It does not 
have a tendency to topple. Such walkers have four or more legs typically coming out at 
the sides of their torso/chassis. They tend to have a sprawling posture with a low CoM. 


Motion is slower than that in case of ZMP-based and dynamic walking. 


Creeping is an example of static walking. It involves lifting and placing one leg at a 
time. A periodic creeping gait is called crawling. A non-periodic creeping gait is called 
a free gait. It is used in rough terrain to search for safe foot-holds, avoiding obstacles 
and maintaining static stability (Kajita and Espiau, 2008). When you are navigating 


over rocky terrain on all four limbs, you are using a free gait. Several animals are known 
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to use variations of the creeping gait. Man-made walkers using creeping gaits include 
the GE quadruped walking truck (Mosher, 1969), the TITAN series of quadruped robots 
from Tokyo Institute of Technology (Hirose et al., 1997; Arikawa and Hirose, 1996; Kato 
and Hirose, 2001) and the LittleDog by Boston Dynamics (Murphy et al., 2010). 


Many multipeds exhibit a kind of static walking where groups of legs are lifted and 
placed in synchronism. The tripod gait of hexapods involves lifting and placing three 
legs at a time in alternating triangles. Many insects like ants, termites, beetles and 
cockroaches use the tripod gait. Millipedes and centipedes exhibit metachronal wave gait 
where they lift and place several pairs of legs in unison. Static walking calls for usage of 
many legs and is mostly seen in smaller animals. There is no land animal weighing more 


than 100 g capable of walking on six legs (Gonzalez de Santos et al., 2006). 


The Adaptive Suspension Vehicle — the largest hexapod in the world — built by 
Waldron and McGhee (1986) was capable of using free gait as well as tripod gait depend- 
ing on the terrain. The COMET series from Chiba University (Nonami, 2002; Irawan 
et al., 2011; Irawan and Nonami, 2011) and IRobot’s ARIEL are recent examples of man- 
made hexapods capable of tripod gait. Theo Jansen built several multi-legged walkers 
called Strandbeests. They exhibit static walking powered only by the beach wind (Jansen, 
2014). The leg mechanism designed by Jansen is a planar linkage mechanism that mimics 


the leg motion pattern of a walking mammal. 


Appendix A presents an analysis of the kinematics and dynamics of Jansen’s one de- 
gree of freedom (1-DoF) leg mechanism. The kinematic analysis helps determine the foot 
point trajectory. The variation in step length and step height with change in crank radius 
is presented. The dynamic model is constructed using bond graph approach (Karnopp 
et al., 1990). This model helps determine the motor torque profile (and hence the torque 


rating) and the link as well as joint stresses for a given ground reaction force pattern. 


About half of the earth’s surface is presently inaccessible to wheeled vehicles (Knight 
and Nehmzow, 2002). The chief advantage of static walking multi-legged robots is their 
ability to negotiate such arduous terrain. Their applications span transporting of goods, 


civil construction, rescue operations and humanitarian demining among others. 


ZMP-based walking 


Static walking facilitates stable but slow motion in multipeds. For bipeds the legs come 


out under the torso/chassis and the support polygon is too small to make static stability 
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practically possible. Vukobratovic and Juricic (1969) pioneered the zero moment point 
(ZMP)* principle which allows the projection of the CoM to leave the support polygon but 


ensures that the finite-sized stance foot always maintains flat contact with the ground. 


Ichiro Kato and his successors from Waseda University, Japan designed and imple- 
mented several generations of bipeds using the ZMP principle — WL-series, WABOT- 
series, WABIAN-series (Lim and Takanishi, 2007). The Honda P-series culminating in 
the ASIMO (Sakagami et al., 2002; Honda, 2007) also used the ZMP approach. Other 
notable examples are Kawada’s HRP series (Hirukawa et al., 2004) and Sony’s QRIO 
(Nagasaka et al., 2004). The permeance of the ZMP concept in the robotics community 
over thirty-five years has been succinctly reviewed by Vukobratovic and Borovac (2004). 
There does not seem to be any examples of ZMP-based walking in animals except when 


human dancers mimic ZMP-based robots. 


The control approach using the ZMP-criterion is conservative in that the inherent 
mechanical dynamics are damped out. Also, these walkers tend to keep their knees bent 
so as to lower their CoM thus improving stability. Both these factors — damping natural 
dynamics and holding knees in bent position — require the system to be actuated all 
the time. Hence, these walkers consume more energy and have an unnatural looking gait 


compared to human walking. 


Dynamic walking 


In dynamic walking — also called limit cycle walking — the system is statically unstable 
but stable in the sense that it is able to sustain a nominally repeating gait pattern 
without falling down. Hobbelen and Wisse (2007) defined limit cycle walking as “a 
nominally periodic sequence of steps that is stable as a whole but not locally stable at 
every instant in time.” Consider a two-dimensional (2D) walker whose walking motion 
is restricted to its sagittal plane. The state of a 2D dynamic walker can be specified 
in terms of a displacement quantity (angular displacement @ of weight-bearing leg w.r.t 
vertical) and a velocity quantity (CoM velocity v). A plot between these two quantities 
— called the state space trajectory or phase portrait — provides a graphic visualization 
of the dynamics of the walker. For limit cycle walking, this state space trajectory is cyclic 
and is said to have orbital stability or cyclic stability (Strogatz, 2001). In the absence of 


energy losses, this trajectory would represent a particular mechanical energy level of the 


*The term ZMP is not used in the paper; It was coined later. 


1.3. Gaits in legged locomotion 10 


system akin to the orbital energy levels of electrons in atoms. 


Such systems tend to have an upright posture with a high CoM. Like ZMP-based 
walkers, the legs come out under the torso. But the knees (if any) are mostly in fully 
extended position when bearing weight. The control approach is more adventurous as 
it tries to use the inherent mechanical dynamics of the system — inertia of motion 
and tipping moment due to gravity — instead of damping it completely. The gait looks 
natural. It is energy efficient as motion is largely achieved because of the pendular energy 
exchange between gravitational potential energy and kinetic energy. At every step, the 
collision of the foot against the ground causes some energy loss. This lost energy has to 
be compensated for in order to have a sustained gait. Losses can be reduced if some of 
the impact energy is stored in compliant elements rather than being dissipated. Dynamic 
walking is faster than static walking as well as ZMP-based walking (for the same spent 
energy) but slower than most ballistic gaits. In nature, several mammals (including 


humans) and birds exhibit dynamic walking. 


Among man-made creations, passive (unactuated) dynamic walking was first seen in 
stiff-legged bipedal toys’ that walked down shallow inclines. Various versions of these toys 
are described in several old patents (Fallis, 1888; Bechstein, 1912; Mahon, 1914; Wilson, 
1938) and by McMahon (1984a,b). Inspired by these toys, McGeer (1990a,b) designed 
some impressive mechanisms that exhibit passive dynamic walking on gentle down slopes 
without and with knees. These 2D passive walkers need no control or energy inputs and 
are powered only by gravity. McGeer’s ‘bipeds’ are four-legged with one inner pair of legs 
and one outer pair of legs. Each pair moves in unison resembling the walk of a man on 
crutches. Proceeding further on McGeer’s ideas, Andy Ruina and his group developed 
several passive and passive-based walkers. Collins et al. (2001) built the first 3D passive 
dynamic walking robot with two legs and knees. The rolling and yawing tendencies in 


their prototype are kept in check using a special foot design and counter-swinging arms. 


Adding actuators to passive walking systems make them capable of walking on level 
surfaces without the need for a ramp. Such dynamic walking systems with minimal 
actuation and control are also called under-actuated walkers. They use actuation at one 
or more of the three joints — ankle, knee and hip. Some salient examples are MIT’s Spring 
Flamingo (Pratt and Pratt, 1999; Pratt, 2000), Cornell and Delft bipeds (Collins et al., 
2005; Collins and Ruina, 2005), Delft’s MIKE (Wisse and van Frankenhuyzen, 2006), 
Twente’s Dribel (Dertien, 2005, 2006) and Cornell Ranger (Bhounsule et al., 2014). 


tsometimes called Wilson Walkies 
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Choosing a locomotion alternative 


If speed is of primal importance in a particular case of terrestrial locomotion, then hard 
wheels on hard and even surfaces is the best solution. The other option is to use legged 
systems employing ballistic gaits. But they can be more energy intensive than wheels 
unless the terrain is off road. Sometimes the ability to move with low energy expenditure 
could matter more than being able to move fast. For example, going on a jungle trail, in 
a desert or grassland, in planetary exploration and so on. Such off-road terrains, where 
people and animals can walk, are places where vehicles/robots could resort to dynamic 
walking gaits to get maximum energy efficiency albeit at low speed. The scope of this 
thesis lies in such gaits. On the other extreme, if the terrain is highly uneven, neither 
wheeled locomotion nor dynamic walking may be possible and static walking has to be 


resorted to, in the interest of stability. 


1.3.3 Description of gaits 


Visualization or graphical description of gaits can be done using foot marks, support se- 
quences (Muybridge, 1957), gait diagrams (Hildebrand, 1965), photography and videog- 
raphy. Muybridge photographed gaits of several running mammals using a series of cam- 
eras triggered in rapid succession. His pioneering work played a key role in understanding 


animal gaits and in starting legged locomotion as a field of research. 


Some of the terminology commonly used in legged locomotion literature to describe 
various aspects of a gait is now discussed. Take the case of a biped dynamic walker like 
a human. Figure 1.4 illustrates some of the terms associated with human walking. Each 
leg has a stance phase (when it is on the ground) and a swing phase (when it is in the 
air). At the start of a stance phase, there is an energy dissipating heel strike. Then 
the walker passively vaults over the stance leg like an inverted pendulum keeping the 
knee extended, the leg stiff and the foot flat on the ground. During this time, the swing 
leg is in retracted position. This helps prevent the swing leg from scuffing against the 
ground thus disturbing the inverted pendulum. The stance leg is vertical at mid-stance. 
Towards the end of a stance phase, toe-off happens where the calf muscles extend the 
ankle to push against the ground. This push-off is the ‘power stroke’ that replenishes 
the mechanical energy lost during heel strike. This ensures that the system has enough 
mechanical energy for the vaulting over the next stance leg to commence the way it 


happened in the previous stance phase. 
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Figure 1.4: Description of human walking. Illustration adapted from Inman et al. (1981). 


A complete walking cycle is called a stride. From the heel strike of a leg to the 
next heel strike of the same leg comprises a stride. Fraction of the stride duration for 
which a given foot is on the ground is called duty factor (3). The two legs of a biped 
alternately switch roles as stance and swing legs with a small overlap period known as 
double support. The double support duration as a fraction of the stride duration can be 
expressed as 23 — 1. So a biped dynamic walker with a duty factor of 0.6 has a double 
support duration that is 20% of the stride duration. The horizontal distance moved in 
one stride is called stride length (A). The reciprocal of the stride duration is called stride 
frequency. An event happening on one leg to the corresponding event on the other leg 
comprises a step. The distance moved in one step is called step length and the reciprocal 
of step duration is called step frequency or cadence. Note that step lengths for left and 
right legs need not be equal. 


During a stance phase in walking and running, the characteristic ground reaction 
force (GRF) patterns experienced at the foot are shown in Figure 1.5 (Geyer, 2005). The 
vertical component of GRF tends to have a two-hump! shape for dynamic walking and a 
bell shape for running. The double-hump shape is seen not just in normal human walking 
but also in tip-toe and high-heel walking as well as in walking ostriches (Usherwood et al., 


2012). For a stance duration extending from —7/2 to +7/2, Alexander and Jayes (1980) 


tLike a Bactrian camel’s back 
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Figure 1.5: Characteristic ground reaction force (GRF) patterns observed during the stance 


phase in walking (A) and running (B). Illustration taken from Geyer (2005) with permission. 


expressed the vertical GRF as follows: 


pea) as 


where A is chosen so as to make the mean value of F’,, over a complete stride, equal to 
body weight. The parameter gq is called shape factor as it determines whether the force 
is two-humped (positive qg) or bell-shaped (negative q) or anywhere in between. The 
horizontal component of GRF is negative in the first half of the stance phase and positive 


during the second half. 


1.4 Models of walking 


Several models for walking (Figure 1.6) have been proposed and analyzed. These models 
capture the essential aspects of human walking to varying degrees. They have been 


subsequently used for designing and building robotic walkers. 


1.4.1 Inverted pendulum model 


The simplest and probably the most elegant model for 2D dynamic walking is the inverted 
pendulum model (Figure 1.6a). Alexander (1976) describes it as the minimal bipedal 
walker. It comprises repeated vaulting of the CoM (mass m) over a rigid massless leg 


of fixed length (1). The rigid leg assumption draws on the fact that humans typically 
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Figure 1.6: Models of walking: (a) Inverted pendulum, (b) Rimless spoked wheel, (c) Linear 
inverted pendulum (d) Synthetic wheel, (e, f) Inverted pendulum with heavy legs, without and 
with knees, (g) Spring loaded inverted pendulum. Adapted from Alexander (1995). 


keep the knee of the weight-bearing leg fully extended. The massless leg assumption is 
permissible since the mass of the leg is much smaller than the total mass of the biped. 
The two legs alternate their roles of bearing the weight (stance) and being in the air 


(swing). The CoM rises and falls tracing a series of arcs of radius equal to the leg length. 


Assuming symmetry of the CoM trajectory about mid-stance, the step angle (@m) is 
the angle made by the stance leg with the vertical at the beginning and the end of a 
stance phase. If the step lengths of both legs are equal, the step angle is half the inter-leg 
angle at heel strike. At any arbitrary instant during the stance phase the angle of fall of 
the inverted pendulum is denoted as ¢. The maximum fall angle equals the step angle. 
The angle made by the new stance leg with respect to the ground is called the angle of 
attack and equals 90° — ¢,. 


The step length (/,) and the CoM height variation (Ah) predicted by the inverted 
pendulum model are as follows. 
1, = 2lsin bm (1.6) 


Ah = I(1 — cos bm) (1.7) 


The CoM height variation over a stance phase of a human is empirically found to be 
about 40 mm (Margaria, 1976). Assuming a leg length of 1 m, this gives a step angle of 
about 16°. The corresponding step length works out to 0.55 m. The step angle as well as 
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the step length calculated from the model are lesser than observed typical values — 20° 
and 0.7 m. This can be explained by a flexible finite-sized foot as opposed to a point foot. 
Such a foot leads to a finite double support duration during which the walking deviates 
from the inverted pendulum model. The CoM trajectory near its minimum height point 
is smoothened out as shown by Cavagna et al. (1977). The inverted pendulum model 
with point feet implies instantaneous support transfer from one leg to the other. This 


only allows for an infinitesimally small double support duration. 


Since gravity provides the centripetal acceleration for the CoM, the model predicts a 
maximum possible mid-stance speed vg of ./gl which evaluates to 3.1 m/s. Usherwood 
(2005) argues that an average forward speed of \/gl can only be realized for step angle 
close to zero and prohibitively high step frequencies that are not practically realizable. 
Using basic mechanics, he proves that the maximum realizable mid-stance speed (and 
hence average forward speed) is lower than \/gl for fall angles larger than zero. The 
upper limit for the step angle is about 48° which can be realized only for close to zero 
mid-stance speed (see Figure 3.1). Note that this upper limit is independent of leg length 


and gravitational acceleration. 


Race walkers are able to achieve up to 4.4 m/s — much greater than 3.1 m/s — 
which implies that their walking gait is not akin to an inverted pendulum. This has been 
validated by two observations. (1) They move their hips in peculiar ways so that the arc 
formed by the CoM trajectory has a radius larger than leg length (Alexander, 1996). (2) 
Even though they are supposed to be walking, slow motion videos have shown that they 


indeed have an air-borne phase (Pavei et al., 2014). 


Garcia et al. (1998) show numerically and analytically that the compass gait of the 
inverted pendulum model explains the passive dynamic walking achieved by McGeer’s 
walkers down an incline, when the legs have finite point masses at the foot. Also, a 
substantial metabolic cost associated with step-to-step transitions in human walking is 
because of walking like an inverted pendulum (Kuo et al., 2005; Kuo, 2007). The inverted 
pendulum model thus explains several aspects of bipedal dynamic walking and is hence 


preferred in this work over other multi-body models. 


1.4.2 The rimless wheel 


The problem of ground scuffing in bipeds caused by the swing leg can be solved in many 


ways. Bipedal ramp-walking toys tackled it by rocking from side to side. Another solution 
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is to have retractable legs using knees or telescopic legs. This would require an extra 
actuator (per leg) that actuates the retraction. The rimless spoked wheel (Figure 1.6b), 
actuated at the hub, facilitates a repeating sequence of inverted pendulum vaults without 


the added cost and complexity of extra motors for swing leg retraction/actuation. 


Bekker (1961) mentioned the conceptual similarity in the CoM kinematics and dy- 
namics of a walking biped and that of a rolling polygon. Much like a rolling polygon, a 
rimless wheel, with only one motor at its center, could serve as a model for the inverted 
pendulum walking of bipeds. It can be pictured as a wagon wheel with the rim removed 
and having sturdy spokes that can bear large compressive forces (Margaria, 1976). The 
rolling motion of the rimless spoked wheel can be described as a ‘walk’ since the loco- 
motor’s point of contact with the ground shifts discontinuously from one spoke (leg) to 


another. 


Dynamics of a passive rimless wheel rolling down a slope have been analyzed for both 
2D (McGeer, 1990a) and 3D (Coleman et al., 1997) cases. Smith and Berkemeier (1998) 
modelled the motion of a finite-width rimless wheel in 3D. The consecutive spokes in 
their model are on alternate sides of the wheel thus taking into account the finite leg 
separation in humans or robots. Passive walking rimless wheels (on downward incline) 
with springy feet and visco-elastic legs have been demonstrated (Narukawa et al., 2009; 
Asano et al., 2012). Rimless wheel actuated by radially expanding legs have also been 
explored (Asano, 2009; Yan and Agrawal, 2004). There does not seem to be any attempt 
at a hub actuated rimless wheel walker. OutRunner built by Robotics Unlimited uses 
the rimless wheel approach for running (Robotics-Unlimited, 2014). It uses springy legs 


that help store and release the impact energy. 


Rimless wheels with various number and shapes of spokes have been employed as 
solutions for traversing difficult terrains. European Space Agency’s PRELERO used six 
such ‘wheels’ each with only one spoke (Martin-Alvarez et al., 1996). Boston Dynamics’ 
RHex also used six of them each having three arc-shaped spokes (Saranli et al., 2001). 
The Biorobotics Group at Case Western Reserve University built the WHEGS™series of 
robots using three straight spokes per rimless wheel (Quinn et al., 2002; Morrey et al., 
2003; Allen et al., 2003). 


Existing prototypes of the rimless wheel focus either on its passive walking on a 
downward incline or on its multi-terrain capabilities. The present work explores their 
potential for energy efficiency when used as dynamic walkers in normal terrains (places 


where humans can walk normally). The rolling rimless wheel serves as a platform for 
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investigating the dynamics and energetics of inverted pendulum walking with constant 


step angle. 


1.4.3. Other models 


Kajita et al. (1990) proposed the Linear Inverted Pendulum Model (LIPM; Figure 1.6c) 
for bipedal walking. It assumed a constant CoM height throughout the walk. They 
designed and implemented a 2D biped and later a 3D biped (Kajita et al., 2001) using the 
LIPM approach. Though the LIPM has enabled the implementation of several successful 
biped walkers, these walkers are quite energy intensive on account of being ZMP based. 
Luo et al. (2013) proposed the possibility of achieving limit cycle walking using LIPM. 
Even then, the LIPM does not capture the vertical excursions of the CoM observed in 


natural walkers. 


McGeer (1990a) discusses the concept of a synthetic wheel (Figure 1.6d) that simulta- 
neously performs a biped-like walk and a wheel-like roll on account of having arc-shaped 
feet whose radius of curvature equals the leg length. At each step, the swing foot lands 
just ahead of the stance foot to virtually synthesize the effect of a rolling wheel. But like 
the LIPM, this model also maintains a constant CoM height. McGeer also proposed a 
couple of models having heavy legs without and with knees (Figure 1.6e,f). These mod- 
els get closer to accurately describing bipedal gaits albeit with increased mathematical 


sophistication. 


The Spring Loaded Inverted Pendulum (SLIP; Figure 1.6g) or the spring-mass model 
incorporates a compliance element so that the leg of the inverted pendulum is no longer a 
rigid member of fixed length. This model was originally used for describing ballistic gaits. 
By suitably adjusting the spring stiffness, Geyer (2005) used it to encompass walking as 


well. 


1.5 Thesis scope 


Wheeled systems are energy efficient on prepared surfaces like roads and tracks. Legged 
systems are capable of traversing different terrains but can be lossy. At low speeds 
and on off-road surfaces, legged systems using dynamic walking can be energy efficient. 
Towards this objective, the dynamics of the walker needs to be modelled and controlled. 


In addition, the braking and ground impact losses need to be minimized. This thesis 
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Controller 


@ ® @ 


Figure 1.7: Scope of the thesis. Numbers denote the problems addressed (see text below). 


presents analysis and experiments on the dynamics and control of a rimless-spoked-wheel 
based mobile robot (Chatur) that belongs to a category between wheeled and legged 


systems. 
The thesis addresses the following problems: 


(4) Modelling the natural load dynamics and energetics of a rimless wheel based 2D 
dynamic walker and achieving sustained forward motion with pulsed torque actuation of 


varying pulse width. 


(2) Investigating the physical constraints that impose fundamental limits on the choice 
of operating points of a generic inverted pendulum walker and locating optimal operating 


points. 


(3) Developing a control topology for pulsed torque actuation of a rimless wheel based 
dynamic walker with its characteristic cyclic variations in reflected load torque and with 


wheel synchronization. 


1.6 Thesis outline 


Chapter 2 discusses the dynamics of a hub-actuated rimless wheel ‘walking’ on level 
ground. Various actuator torque profiles can be used to achieve dynamic walking of the 
rimless wheel. This chapter proposes a pulsed actuation torque giving rise to four torque 
regimes that achieve sustained walking and a fifth regime where the walker keeps slowing 


down with each step. The regimes are defined based on the relative magnitudes of energy 
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losses and available actuator torque and can be identified based on the fraction of stance 
phase for which the actuator is energized. Theoretical analysis and experimental results 


are presented. 


A simple closed-form analytical solution, using hyperbolic functions, is proposed for 
the stance phase inverted pendulum dynamics considering planar motion. Ground im- 
pacts are assumed to cause abrupt drop in velocity. A constant braking torque that 
lumps together the effect of several loss phenomena is also considered. Based on whether 
the CoM is rising or falling and whether or not there is an actuating torque, a stance 
phase can have four types of sub-phases — actuated rise, unactuated rise, actuated fall, 
unactuated fall. These are concatenated in four different ways to form repeating cycles 
yielding the four regimes. The experimental set-up is a fixed step-angle 2D dynamic 
walker named Chatur. It is constructed using two synchronized adjacent rimless wheels 
actuated at the hub using separate BLDC motors. Varying the magnitude and duration 
of the torque pulse, the proposed regimes are experimentally shown. The mechanical 
power consumption and cost of transport are computed from measured motor currents 


for different average forward speeds. Videos of the walks are also taken. 


Chapter 3 investigates the choice of operating points for an inverted pendulum based 
bipedal dynamic walker in terms of constraints and optimality. The operating point of 
the walker can be specified by the combination of initial mid-stance velocity (vo) and step 
angle (¢) chosen for a given walk. Not all operating points lead to a realizable steady- 
state gait. In this chapter, using basic mechanics, a framework of physical constraints 
that limit the choice of operating points is proposed. The constraint lines thus obtained 
delimit the valid region of operation of the walker in the vp-dm, plane. Within this 


allowable region, sub-regions that result in various regimes of walking are identified. 


A given average forward velocity vz,q,g can be achieved by several combinations of 
Up and @m. Only one of these combinations results in the minimum mechanical power 
consumption and can be considered the optimum operating point for the given Vz avg. This 
chapter proposes a method for obtaining this optimal operating point based on tangency 
of the power and velocity contours. Putting together all such operating points for various 
Uz,avg, & family of optimum operating points, called the optimal locus, is obtained. For the 
energy loss and internal energy models chosen, the optimal locus obtained has a largely 
constant step angle with increasing speed but tapers off at non-dimensional speeds close 
to unity. Thus, choosing the right step angle and keeping it fixed over a broad range 


of speeds could lead to an inverted pendulum walker that is close to optimal from a 


1.6. Thesis outline 20 


mechanical energy perspective. 


Chapter 4 elaborates the hardware design and proposes a control topology for pulsed 
torque actuation of Chatur, the rimless-wheel based mobile robot mentioned earlier. Pit- 
falls and caveats associated with reliable performance of the mechanical and electrical 
subsystems are pointed out. In order to ensure lateral stability, the system uses two 
contralateral wheels each driven by a separate BLDC hub motor. From a motor drive 
perspective, the mechanical load belongs to a unique class of dynamic loads whose re- 
flected torque has a characteristic cyclic variation that repeats several times within a 


mechanical revolution. 


The proposed control scheme has two hierarchical levels, an inner loop for torque 
control of BLDC motor implemented using a standard proportional-integral controller, 
and an outer loop for torque reference generation that uses the information on the ground 
impact instants and the motor position feedback. Ground impacts of the spokes are 
detected by an accelerometer to initiate the application of torque. The torque pulse 
magnitude can be set internally or by a manual operator via radio control. The pulse 
duration is programmable and enables attainment of various torque regimes at different 
steady state speeds. The wheels are synchronized so that corresponding spokes on both 
wheels move in unison. This is achieved by including a wheel synchronization loop that 
compensates for any lag between the wheels. Lag is detected based on number of sector 
changes in the hall-effect position sensor data received from both motors. An improved 
BLDC motor drive is developed wherein non-commutating current feedback is used to 
reduce current spikes during sector transitions. Experimental waveforms for controller 


validation are shown. 


Chapter 5 summarizes the key research contributions made in the thesis and gives 


pointers for future work. 


Chapter 2 


Modeling of Dynamics and Torque 


Regimes 


Existing prototypes of the rimless wheel focus either on its passive ‘walking’ on a down- 
ward incline or on its multi-terrain capabilities. This chapter discusses the dynamics of 
a hub-actuated rimless wheel walking on level ground. Various actuator torque profiles 
can be used to achieve dynamic walking of the rimless wheel. A pulsed torque actuation 
is proposed giving rise to four torque regimes categorized by the pulse width range. A 
closed-form solution is proposed for the stance phase dynamics considering planar motion 
of an inverted pendulum (as an equivalent to a rimless spoked wheel with zero radius of 
gyration). Sustained forward motion spanning all four proposed regimes is achieved in 


an experimental prototype. 


2.1 Passive walking on level ground 
Consider a rimless wheel based walker, with stiff massless spokes, walking on level ground 


without any actuation. The ideal (lossless) and practical (lossy) cases are discussed in 


this section. 


2.1.1 Ideal case 


Figure 2.1a shows the free body diagram of the ideal rimless wheel walker. Only the spoke 


that is resting on the ground (stance leg) is shown making it an inverted pendulum. The 
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oa = mglsin dp 
2 | rx Se aN 
Tq = mglsing Tg = mglsing 


(a) Ideal: no braking, no actuation. (b) Practical: with braking and actuation. 
Figure 2.1: Free body diagram of a rimless wheel based walker of mass m, leg length / and 
instantaneous fall angle ¢. Only the stance spoke is shown making it an inverted pendulum. 


Tg, Ta and 7 denote gravitational, actuator and braking torques. 


other spokes are assumed to have no effect on the dynamics (until impact when the stance 
leg changes) and are hence not shown. Gravity applies a torque mgl sin @ on the inverted 
pendulum about the foot point of the stance leg. The differential equation describing the 


dynamics over one stance phase is 


—~ — =sing = (2.1) 
The following constraints are used: 


1. On account of having a constant inter-spoke angle (2¢,,), the rimless wheel walker 
maintains a constant step angle (¢,,) and hence constant step length for the entire 


walk. 


2. The walker is two-dimensional (2D) without any lateral dynamics i.e. the CoM 


moves only in the sagittal plane. 


The walker starts moving from a vertical position having been imparted a finite CoM 
velocity vp (Figure 2.2a). The initial energy (Fjnjz) imparted to the walker is hence SMUG. 
As the inverted pendulum falls under the influence of gravity, the CoM traces a falling arc 
of radius equal to leg length (/). It loses gravitational potential energy (E,) while gaining 
kinetic energy (F;,). After falling through an angle ¢,, (step angle or stance angle), the 
CoM velocity increases to v, (Figure 2.2b). If the transformation between gravitational 


potential energy and kinetic energy is lossless, conservation of mechanical energy yields 


ve, = ve + Qgl(1 — cosdm) (2.2) 


23 2.1. Passive walking on level ground 


4 vo 


Um COS Pm 
Um Sin om{ 1) 


Um COS2Om 


Um Sin 2om Um 


VAY 


Figure 2.2: Forward motion of an inverted pendulum walker with (a) initial mid-stance velocity 
vo, (b) step angle ¢m, pre-impact velocity vm, and (c) post-impact velocity v},. The step length 
(1,) and CoM height variation (Ah) are annotated. The CoM traces a trajectory consisting of 


a series of arcs of radius equal to the leg length (1). 


At this instant, the next leg strikes the ground and becomes the new stance leg (Figure 
2.2c). If this ground impact were to be lossless, the CoM velocity uv, gets instantaneously 
redirected along the arc corresponding to the new stance leg without any reduction in 
magnitude i.e. vu), = Um. The CoM now traces a rising arc. The walker again reaches 
the mid-stance position at a CoM velocity vp. This cycle can keep repeating indefinitely 
and steady forward motion is obtained without any net mechanical energy input to the 
system except at the start (Finiz; see Section 1.2). This ideal walker can execute passive 
walking on a level surface. Figure 2.3 plots, in black solid lines, the fall angle ¢(t) and 
the CoM velocity v(t) of this ideal walker. These are obtained by solving Equation 2.1 


and are similar to the time domain waveforms presented in Pratt and Drakunov (2007). 
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Figure 2.3: Fall angle ¢(t) and CoM velocity u(t) of ideal (black solid line) and practical (black 
dashed line) inverted pendulum walker on level ground, without actuation. Actuation (red dash 
dots) can put the system back to the state where it started (v = vo, 6 = 0) thus enabling a 


sustained walk. The actuation torque may be present only for a portion of the stance phase. 


2.1.2 Practical case 


Practical walkers have braking as well as ground impact losses. This subsection models 


these two losses and discusses their effects on the dynamics and energetics of the walker. 


Braking loss 
Various phenomena that have a braking effect on the walker are listed below. 


1. In human walking, some of the muscles perform negative work during the lowering 
of the CoM. They are fighting the fall dissipating energy as heat (Kunzig, 2001; 
Cavagna et al., 2002). Motors at the joints of a robotic walker can have opposing 


detent torques. 
2. The active and passive rotary joints have Coulomb friction losses. 


3. A finite sized foot pressing against the ground causes deformation in the foot as 
well as the ground. This results in a rolling resistance which can have a braking 


effect on the walker. 
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The braking loss can be modeled by considering a continuous braking torque (7) about 
the foot point. This torque lumps together the effects of all three phenomena mentioned 
above and continuously tries to slow down the walker. Strictly speaking, this torque 
need not be constant but assuming a constant braking torque is permissible because 
of two reasons: (i) the effect of braking torque on the dynamics of the walker is much 
smaller than that of the gravitational torque (and actuator torque, when present) and 


(ii) mathematical tractability. The braking torque is taken as 
T, = mgl sin dy (2.3) 


where @ is the braking torque parameter. Putting the braking torque in this form 
enables easy comparison with the instantaneous torque due to gravity (mgl sin @). It also 
facilitates an analytical solution for the dynamics of the walker (Section 2.3) with better 


insights. 


As a result of braking loss, the transformation between gravitational potential energy 
and kinetic energy is not 100%. The energy lost to braking as the walker falls through 


an angle @,, from the vertical (half a stance phase) is given by 


Pork (braking torque) x (angular displacement) 


> TePm = mglom sin Pb (2.4) 


Conservation of energy gives an expression for the CoM velocity v,, at the lowest 


potential energy position. 
ve, = vp + 2gl(1 — cos dm — bm sin ds) (2.5) 


With braking loss, the CoM velocity uv; achieved at the end of a passive fall is lower than 
that for the ideal case (Equation 2.2). The differential equation describing the dynamics 


of one stance phase of this practical walker with braking loss can be derived as 


Po 9. is 
qe sin ¢ 4 i sin dp = 0 (2.6) 


Impact loss 


In the absence of compliant elements to store and release the impact energy, the heel 
strike is lossy. It causes vibrations and heat dissipation resulting in an impulsive energy 


loss in the system. The kinetic energy at the start of the new stance phase is hence lesser 
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Figure 2.4: Ground impact loss models showing the drop in CoM velocity for various step 


angles. Higher v/,,/vm implies lower losses. 


than that at the end of the previous stance phase. The post-impact CoM velocity v/, is 


less than U,,. 


Alexander (2003) suggests that the vertical component of v,, is completely lost on 
ground impact where as the horizontal component is completely retained (see Figure 2.2b). 


Hence, the kinetic energy lost on impact is 
dy £9 at) 
Lag git m sin Oe (2.7) 


The kinetic energy at the start of the new stance phase just after ground impact is 


computed as 


1 
12 2 
gm = gm 


The post-impact CoM velocity simplifies to 


1 
— Eimp = 5m cos” bm (2.8) 


= COS, (2.9) 


In case of a rimless wheel with finite radius of gyration, McGeer (1990a) used conser- 


vation of angular momentum about the impact point to calculate the loss in speed. 


cos 2bm + r2,,, 
ay ee (2.10) 
r+7, 


where 7gyr is the radius of gyration normalized by leg length /. For r4,, = 0, the rimless 
wheel is equivalent to an inverted pendulum and the impact loss model in Equation 2.10 
reduces to 

0, = Vj C08 20 (2.11) 


It is possible to arrive at Equation 2.11 by a different approach. Upon heel strike, the 


CoM cannot have any component of motion in the direction of the colliding leg because 
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of the rigid leg assumption. Hence, the component of v,, along the new stance leg is 
completely lost while the component perpendicular to it is unaffected (see Figure 2.2b). 


The kinetic energy lost on impact is 
Le ee 
Pa giUm sin 2om (212) 


The kinetic energy at the start of the new stance phase is 

I eal ee ee 

5m = 5m — Ey 5m COS 20: (2213) 
Equation 2.13 yields a post-impact CoM velocity as given by Equation 2.11. Figure 2.4 
plots the impact loss models described above (Equations 2.9-2.11) in terms of vu’, /Um 
versus dm. A higher value of v/,, /Um indicates lower impact losses. Equation 2.11 is used 


in subsequent analysis of the dynamics of the walker. 


Note that while braking loss occurs continuously, the ground impact loss is almost 
instantaneous*. Solving Equation 2.6 for the initial conditions ¢; = 0, v; = vo yields 
the fall angle ¢(t) and the CoM velocity v(t) till heel strike. The impact loss causes an 
instantaneous change in state from (¢ = ¢@m, V = Um) to (¢ = —@m, v = v,,). Solving 
Equation 2.6 again for these new initial conditions gives the time evolution of ¢(t) and 


u(t) post impact. 


Figure 2.3 plots, in black dashed lines, the fall angle ¢(t) and the CoM velocity v(t) 
of this lossy walker. Notice how the losses force the dynamics to slow down. If no 
measures are taken to replenish the energy lost to braking and impacts, this walker keeps 
slowing down till there is not enough energy to take the CoM to the highest potential 
energy position. The walker finally has to fall back instead of vaulting forward. This 
could happen in the next step or within a few steps, depending on the initial mid-stance 


velocity and the magnitude of the losses. 


The total energy loss in one stance phase is given by 


Peas = Peptic are 


1 
2ngldm sin dy + 5 in sin? 2dm (2.14) 


*Braking and ground impact losses are analogous to conduction and switching losses in semiconductor 


switches. 
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2.2 Sustained forward walk 


2.2.1 Downward incline 


One way to achieve a sustained inverted pendulum type walk, is to make the passive 
walker go down a ramp that is at fixed angle y to the horizontal. The passive dynamic 
walkers mentioned in Section 1.3.2 use this approach. Introducing just the right amount 
of downward incline enables gravity to compensate for the impact and braking losses. 
The stance phase differential equation that describes this dynamics is given by 
do 
dt? 


If the slope is too small, gravity might not be able to compensate for the losses. The 


— Fsin(¢ Ly) 4 T sings = 0 (2.15) 


walker cannot have a sustained walk and eventually falls back. If the slope is too large, 
the walker keeps accelerating. Finally, the swing leg fails to catch up and be placed 
in time and the walker falls forward. A slope in between these two extremes enables 
the walker to passively walk down the slope at a nominally constant forward velocity 


determined by the slope angle. 


2.2.2 Torque actuation 


In the absence of a downward incline and in order to get a controllable average forward 
velocity, an actuator is required. Several passive-based dynamic walkers using actuators 
have been demonstrated (see Section 1.3.2). The actuator puts in just the right amount 
of mechanical energy in every stance phase to compensate for losses and puts the system 
back to the same state where it started thus enabling a sustained walk (see Figure 2.3, 
red dash dots). Various actuator torque profiles can be used to achieve a sustained walk. 


For the sake of simplicity, let the actuator apply a constant torque given by 
Ta = mglsin ba (2.16) 


where @, is the actuator torque parameter. As in the case of braking torque (Equation 


2.3), Equation 2.16 expresses T, in a form similar to the torque due to gravity (mgl sin @). 


In human walking, actuation is provided by the push-off of the trailing leg during 
the finite double support duration (Figure 2.5). The push-off force is a result of the calf 
muscles pulling the portion of the foot behind the ankle joint thus making the toe end of 
the foot push against the ground. The point of application of this force is about a step 
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Figure 2.5: In human walking, the vertical component of ground reaction force (GRF) of 
the trailing leg during the double support duration provides the actuation torque: T, *& 
(vertical GRF) x (step length). Average value of the vertical GRF over the double support 
duration could be about 0.7mg. Adapted from Geyer (2005, chap. 1). 


length (1,) away from the stance foot thus providing a mechanical advantage. It is capable 
of generating appreciable actuation torque on the system even with a modest magnitude 
of push-off force. Once the trailing leg leaves the ground there is no actuation on the 
system. Hence, the actuation can only be pulsed but not continuous. The actuation 
torque need not be constant valued. Equation 2.16 can approximate the effect of this 
varying actuator torque by using a value of 7, equal to the average value of the torque 
for the double support duration which in turn is obtained from the average value of the 


vertical ground reaction force (GRF) during that duration (Figure 2.5). 


Robotic walkers with actuated feet mimic the actuation method in humans and hence 
imbibe the merits and demerits discussed above. In a robotic walker without actuated 
feet, the motor that provides actuation could be at the hip joint as in case of a hub- 
actuated rimless wheel. In such a case, there is no mechanical advantage and hence 
the motor torque requirement is higher. Actuation can be either pulsed or continuous 


depending on the fraction of the stance phase for which the motor is energized. 


In presence of actuation, conservation of energy gives (compare with Equation 2.5) 
v2, = v5 + 2gl(1 — cosdm + bmbc) (2.17) 


where 


De = sin Pa — sin Onn (2.18) 
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2.3 Analytical solution for the dynamics 


Incorporating braking and actuator torques, the free body diagram of the inverted pen- 
dulum is shown in Figure 2.1b. The stance phase dynamics of this practical inverted 


pendulum walker on level ground is formulated by 
. ' Gat as 
qa pine — 7 sin ga + 7 sin by = 0 (2.19) 


Equation 2.19 is a non-linear differential equation and can be solved numerically. 
Using the small angle approximation (sing = ¢ for small ¢) gives us a mathematically 


tractable linear differential equation. 


2 70 — Fsings + Fsindy = 0 (2.20) 
The maximum step angle in humans is about 25° which is not a small enough angle to war- 
rant the use of the small angle approximation. So the analytical solution to Equation 2.20 
can have appreciable error with respect to the exact numerical solution of Equation 2.19. 
Yet, it can provide insight on the relative effects of various parameters on the dynam- 
ics. Taylor and Thomas (2014, chap. 3) present an analytical solution for the inverted 
pendulum model. Their solution uses elliptic integrals and is hence not a closed-form so- 
lution. In this work, a simple closed-form analytical solution using hyperbolic functions 


is proposed. 


It is assumed that the actuation is either continuous or, if pulsed, is initiated at the 
instant of ground impact. If the actuation is continuous, Equation 2.20 holds throughout 
the stance phase. If actuation is pulsed, the differential equation changes for the portion 
of the stance phase that is unactuated. The (g/l) sin @, term vanishes for the unactuated 
duration. In order to obtain an analytical solution for Equation 2.20, separate sets of 
initial conditions are required for the actuated and unactuated sub-phases of a stance 


phase. 


Let us assume the following generic initial conditions at time t = 0: 


d i 
o(t = 0) = ¢; and ae =O; = a (2:21) 
iia ae l 
For the above initial conditions, the analytical solution to Equation 2.20 gives an 
expression for the fall angle as a function of time: 


ot) = * sinh (Wnt) + (de + $;) cosh(Wrt) — o¢ (2.22) 
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Figure 2.6: Comparison of analytical (solid) and numerical (dashed) solutions for inverted 


pendulum dynamics. Parameter values: m = 50 kg, 1 = 1m, ¢@, = 5° and ¢@g = 15°. Initial 


conditions: 6; = —25° and v; = 1 m/s. Final condition: pf = 25°. 


where Up, W, and ¢ (Equation 2.18) are constants. 


Un = Vgl (2.23) 
Wn =4/= (2.24) 


The instantaneous angular velocity of the inverted pendulum is given by: 


OG) = ° = = cosh (Wnt) + (be + $:) + Wy - sinh (Wpt) (2.25) 


The magnitude of the instantaneous CoM velocity is given by: 


v(t) = Q(t)l = v; cosh (Wyt) + (de + Gi) + Un - sinh (Wpt) (2.26) 


The forward velocity of the CoM is the horizontal component of the above velocity. 


Uz(t) = v(t) cos @ (2.27) 


In order to compare the above analytical solution with the numerically computed 
exact solution, consider an inverted pendulum with m = 50 kg and / = 1 m. Consider 
an exaggerated stance phase ranging from @; = —25° to @¢ = 25° with initial velocity 
vu; = 1 m/s. Let d = 5° and ¢, = 15° where the actuation is present throughout the 
stance phase. The analytical solution (Equation 2.22 and 2.26) slowly keeps diverging 
from the exact solution of Equation 2.19 when both are given the same initial conditions 
(Figure 2.6). In this worst case, where the stance leg sweeps through an angle of 50° 
(25° before and after mid-stance), the analytical solution is about 6% higher than the 


numerical solution. For typical fall angles lesser than 25°, the error is smaller. 
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Unlike the above extreme case, generally the actuation is present only for a portion of 
the stance phase. If the walker starts from the vertical position with an initial mid-stance 


velocity vp as in Section 2.1, the initial conditions are 
o: = 0 and vu; = vo (2.28) 


Take ¢, = 0 for this unactuated fall. Substituting these into Equations 2.22-2.27 gives the 
complete dynamics for the unactuated fall. In the absence of braking loss (i.e. ¢@, = 0), 
the fall angle would vary as a sine hyperbolic function and the angular velocity (and CoM 
velocity) as a cosine hyperbolic function. At the instant of ground impact, the actuator is 
energized to give a constant torque (Equation 2.16). The CoM velocity instantaneously 
changes to v/, as given by Equation 2.11. For the subsequent actuated rise of the CoM, 
the initial conditions are 

; = —bm and v; = v1, (2.29) 


Again substituting these into Equations 2.22-2.27 gives the complete dynamics for the 


actuated rise (and fall). 


2.4 ‘Torque regimes 


A nominally periodic sequence of steps can be realised only if the actuator keeps putting 
in the right amount of energy. To achieve a sustained walk, the energy put in by the 
actuator during the time that it is energized should compensate for the losses incurred 
in one stance phase (Equation 2.14). Let the actuator be energized for the duration that 
the inverted pendulum sweeps an angle Ad from ¢ = —¢m to 6 = —dm + Ad. For a 


given actuator torque, A@ works out to 


EB Oss 
Ag = —2 (2.30) 
Ta 
The spatial duty ratio (d;,) of the actuator torque (current) can be defined as 
joe angular displacement when actuated _ A@ (2.31) 


angular displacement in one stance phase 2¢,, 


Based on the value of A@ obtained in Equation 2.30, there are five possibilities. 


Eioss 
Case 1: T, > 3 , AO =< by, dig < 05 


Actuator torque is high enough to be removed before mid-stance (Figure 2.7a). 
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ae? 


Ag 


(b) (c) (d) 

Figure 2.7: Portion of stance phase for which actuation is present in an inverted pendulum 
walker. (a) Regime 1, Ad < ¢@m, (b) Regime 2, Ad = ¢m, (c) Regime 3, dm < Ad < 2¢m, (d) 
Regime 4, Ad = 2¢m. 


ives 
Case 2: T, = ; , NO= Ory d= 0.5 


Actuator torque is just enough to be removed at mid-stance (Figure 2.7b). 


Enos Tiioes 
Case 3: a <Ta< 3 On < BO: = 26m, 0:5 < dis <1 


Actuator torque needs to be removed after mid-stance but before next heel-strike (Fig- 
ure 2.7c). 


Biggs 
Case 4: tT, = a no =204 c= 1 


Actuator torque needs to be applied continuously to sustain a steady walk (Figure 2.7d). 


Press 
Case 5: T, < a AOS 2Oi5 dis > 1 


Actuator torque is insufficient to sustain a steady walk even when applied continuously 


unless the step angle is higher for subsequent steps. 


Consider the parameters as indicated in Table 2.1. For a given ¢,,, v9 can be varied to 
obtain all five cases described above. Figures 2.8—2.10 plot the fall angle, CoM velocity, 
mechanical energy and actuator torque of the inverted pendulum walker for Case 1- 
Case 5 (computed using the analytical solutions obtained in Section 2.3). Each case is 
annotated with the sub-phases marked in terms of whether the CoM is rising or falling 
and whether or not there is any actuation in that sub-phase. There are four types of sub- 
phases — actuated rise (AR), unactuated rise (UR), actuated fall (AF), unactuated fall 
(UF). The rise time of the CoM is generally larger than its fall time. But with reasonably 


high actuator torques, it is possible to achieve almost equal rise and fall times. 
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Table 2.1: Parameter values used for the torque regime waveforms (Figures 2.8-2.10). 


Parameter Value 


m 65 kg 

g 9.81 m/s? 
l dh ia 
Pa 10° 

Pb i 


Case 1—Case 4 delineate the four possible torque regimes for sustained walking of 
the practical inverted pendulum walker. In regimes 1 and 2, the repeating limit cycle 
is achieved within the second mid-stance. The mid-stance velocity is the same for all 
steps. Regimes 3 and 4 achieve limit cycle within the second ground impact. The second 
mid-stance velocity is lower than the first one, but is maintained at that lower value for 
all subsequent mid-stances. Humans mostly exhibit regime 1 limit cycle walking where 
the actuation due to push-off is present only for a short duration at the beginning of a 
stance phase. Sections 2.5-2.6 describe the construction and working of a rimless wheel 


based walker that exhibits all four torque regimes. 


Case 5 leads to a fifth regime that does not yield a sustained walk within the second 
ground impact. It results in the walker slowing down to lower and lower mid-stance 
velocities at each subsequent step till the losses equal the energy put in by the actuator. 
A steady state regime 4 walk could thus be reached in a matter of few steps. If the 
actuator torque is too low, the walker keeps slowing down till it falls back and stops 
walking. Note that once fall back happens, the direction of the braking torque reverses. 
So the term corresponding to braking torque in Equation 2.20 flips sign and the expression 


for the analytical solution changes. 


Figure 2.11 plots the state space trajectories (phase portraits) of the five regimes on 
the @-v plane. The grey lines depict phase portraits of the ideal inverted pendulum 
walker. Since it has no losses, each grey line represents a particular mechanical energy 
level. In presence of losses, the walker keeps falling to lower energy levels. The task of 
the actuator is to restore the system back to the original energy level thus enabling a 
cyclic trajectory. This ‘home’ energy level is defined by the combination of vg and ¢m 
chosen. The repeating cycles, obtained by suitable concatenation of the sub-phases, are 
annotated above each of the phase portraits in Figure 2.11. Regime 5 does not yield 


repeating cycles as seen in the phase portrait. 
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Each of the sub-phase durations (7,,,) is a non-linear function of many variables and 
can be derived using Equation 2.22 and the initial and final conditions for that sub-phase. 


Taking the generic final condition as ¢ = ¢y, a sub-phase duration can be deduced to 
sinh-'z 


=— (2.32) 


sp 


where 


SBi6/ Bea 
se a a C (2.33) 


2A 
A Ue ig + 6%) (2.34) 
v2 Cc a - 
Be= —2(be+ 64) (2.35) 
C = 3-47 — 2b-(¢; — $7) (2.36) 


For any of the four regimes of sustained walking, the stance phase duration (7’) is obtained 
by adding the durations of all the sub-phases involved. The step frequency (f) is the 


reciprocal of the stance phase duration. 
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Figure 2.8: Regime 1 and regime 2 walking 


m = 15° (b) Regime 2 walking: vp = 1.5 m/s, dm = 15° 
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(b) Regime 4 walking: vp = 2.4 m/s, dm = 15° 


Figure 2.9: Regime 3 and regime 4 walking 
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(c) Regime 3 walking: vp = 2 m/s, dm = 15° 


(d) Regime 4 walking: vp = 2.4 m/s, dm = 15° 


ground ground 
28 4 UE 5 tmpact Cc AR D AF punat 
B 
ee ee 
2.6 - 
6 2.4 
> a 
20) ee! 
2, ; | 
-20 -10 10 20 


0 
(degree) 
(e) Regime 5 walking: vp = 2.6 m/s, dm = 15° 
Figure 2.11: Phase portraits for all five torque regimes corresponding to Figures 2.8-2.10. 
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2.5 Experimental prototype 


Chapter 4 gives a detailed description of the experimental prototype (a rimless wheel 
based 2D walker named Chatur) and the control scheme used for pulsed torque control 


of the actuators. A brief outline is given here. 


2.5.1 Hardware 


Figure 4.9 shows the experimental prototype built. Chatur is a fixed step-angle 2D 
dynamic walker implemented using the concept of rimless spoked wheel. Lateral stability 
is ensured by using two contralateral rimless wheels. The mechanical subsystem consists 
of the rimless wheels, a welded mild steel (MS) frame and enclosures for the electronics. 
No attempt is made to minimize weight, so that the heavy parts — MS frame and sealed 


lead acid (SLA) batteries — can emulate payload weight (refer Table 2.2 for part weights). 


The electrical hardware consists of batteries, motors, and PCBs for power and control 
electronics. Each rimless wheel is actuated by a three-phase brushless de (BLDC) hub 
motor with 18 equidistant wooden spokes attached to its external rotor. The BLDC 
motors are driven by three-phase inverters. The sensing, signal conditioning and control 
circuits reside in a controller card designed for Chatur. Table 2.2 specifies the parameters 
of the system to put it in context with the mathematical model. The rated motor current 
(Imax) is 12 A and the motor torque constant (K;) is 0.6 Nm/A. Hence the maximum 
actuator torque parameter (combined effect of both motors driven by rated current) is 
given by 


2D aad, . 
Ddemiage = sin”! (Fa) x 3 (2:30) 


This implies that if the motor is stuck at zero velocity at the lowest potential energy 
position (6 = ¢, = 10°), it cannot raise itself. Owing to this torque limitation of 
the motor, initial raising of the center of mass is done manually and measurements are 
taken for steady state walks of Chatur. The braking torque parameter (¢») is only 
approximately known as it is difficult to separate the impact losses and braking losses in 


experimental measurements. 


As the motor tries to rotate its rotor, there is a counter torque acting on the stator 
that is attached to the frame. In order to stop this counter torque from rotating the frame 
instead of the rimless wheels, a tail piece is added. The end of the tail has a castor wheel 


that rests on the ground. The ground reaction force acting on this castor helps resist the 


41 2.5. Experimental prototype 


Table 2.2: Specifications of Chatur. 


Parameter Value 
Leg length, / 0.57 m 
Step angle, dn, 10° 
Step length, 1, = 2/ sin dm, 0.2m 


CoM height variation, Ah = 1(1 — cos¢m) 9 mm 


Mass, m rimless wheels, 2 x 12 kg 
frame, 7 kg 
batteries, 15 kg 
others, 4 kg 
total, 50 kg 


Motor torque constant, A, 0.6 Nm/A 


Maximum actuator torque parameter, 3° 
Danis (at Lia = 12 A) 


Braking torque parameter, @p ~I1° 


counter torque on the frame. A design without the need for a tail piece and castor wheel 
is also possible. The OutRunner from Robotics Unlimited uses a counterweight, placed 
away from the axle, on the frame to oppose the counter torque (Robotics-Unlimited, 
2014). 


2.5.2 Control scheme 


The torque of the BLDC hub motor is controlled in a pulsed manner. Torque control 
is achieved using a Proportional-Integral (PI) controller for the motor current. Ground 
impacts are detected by an accelerometer to initiate the application of constant torque. 
The magnitude and duration of the applied torque pulse is programmable by the user and 
enables attainment of various regimes at different steady state speeds. The magnitude of 
the torque pulse is set by a manual operator via radio control. The rimless wheels need to 
be synchronized so that corresponding legs on both wheels move in unison without a lag 
between one another. This is achieved by adding an extra term in the torque reference 


that compensates for any lag sensed between the rimless wheels. Lag is detected based 
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a) Ur.avq = 0.37 m/s. b) Uz.avq = 0.33 m/s. 
avg sag 


Figure 2.12: Experimental waveforms for regime 1 walking: (1) Accelerometer output (2 
V/div), (2) Motor-1 sector number, (3) Motor-1 phase current J,; (10 A/div), (4) Torque 
reference (1 V/div), time scale 250 ms/div, dis = 3/8. 


on number of sector changes in the position sensor data received from both motors. 


The rotor position is determined by a 3-bit digital output from a hall effect position 
sensor that is built into the motor. The sensor gives six different position outputs (sector 
numbers) per electrical cycle. This translates to a mechanical position resolution of 2.4° 
for the 25 pole pair motor. The sequence of sector numbers for counter-clockwise (CCW) 
rotation is 5-4—6-2-3-1 (see experimental waveforms in Section 2.6). This is used for the 
right motor on Chatur. The reverse sequence gives clockwise (CW) rotation and is used 


for the left motor. 


2.6 Experimental results 


This section details the experimental results obtained with Chatur. Since the set-up 
is mobile, all waveforms are captured using a battery-operated four-channel oscilloscope 
mounted on Chatur (Figure 4.9). Waveforms for all four torque regimes are depicted. For 
each set of waveforms, average power and average velocity calculations are done based 


on known system parameters (see Table 2.2). Videos of the walks are also taken. 


2.6.1 Torque Regimes 


At the instant of ground impact (detected by an impulse in the accelerometer output), the 
torque reference is raised to a value set by the operator. The torque reference is brought 


back to zero after a predefined number of sector changes following the ground impact. 
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(a) vz,avg = 0.38 m/s. (b) vz,avg = 0.27 m/s. 
Figure 2.13: Experimental waveforms for regime 2 walking: (1) Accelerometer output (2 
V/div), (2) Motor-1 sector number, (3) Motor-1 phase current [,; (10 A/div), (4) Torque 
reference (2 V/div), time scale 250 ms/div, dj, = 4/8. 


(a) vz,avg = 0.49 m/s. (b) vz,avg = 0.36 m/s. 
Figure 2.14: Experimental waveforms for regime 3 walking: (1) Accelerometer output (2 
V/div), (2) Motor-1 sector number, (3) Motor-1 phase current J,; (10 A/div), (4) Torque 
reference (2 V/div), time scale 250 ms/div, dj; = 5/8. 


(a) vz,avg = 0.39 m/s. (b) vz,avg = 0.33 m/s. 


Figure 2.15: Experimental waveforms for regime 4 walking: (1) Accelerometer output (2 V/- 
div), (2) Motor-1 sector number, (3) Motor-1 phase current [,; (5 A/div), (4) Torque reference 
(1 V/div), time scale 250 ms/div, d;, = 1. 
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All waveforms and measurements correspond to nominally steady state walks on ce- 
ment floor. The four torque regimes (Figures 2.12—2.15) are achieved by suitable choice 
of the magnitude and duty ratio of the applied torque. Only one of the motor phase 
currents is shown. Note that the sector dwell times around the ground impact instants 
are smaller than those away from the impacts. This is because the CoM speed and hence 
the motor speed is higher at the lowest potential energy position. Waveforms for two 
operating points of each regime are shown. Several such operating points are taken to 


carry out the power calculations. 


The spatial duty ratio (d;,) of the torque is varied from 3/8 to 1. The motor speed 
is not constant during a stance phase and the rise and fall time of the CoM can also 
be unequal. Hence, the spatial duty ratio can translate to a slightly different temporal 
duty ratio (d;) as seen in the waveforms. The torque magnitude is varied by changing 


the motor current over the range 3-10 A. 


Regime 1 walking is achieved only at higher torques (for J > 8 A) and hence not 
many operating points are obtained. Even for a given speed, not all ground impacts have 
same losses because of practical asymmetries in step angles and non-uniform nature of 
foot points and surface of travel. A walk that is nominally in regime 2 keeps going to 
regimes 1 and 3 every now and then owing to these asymmetries. Similarly, a walk that 


is nominally in regime 4 keeps going to regimes 3 and 5 every now and then. 


If the applied torque is too low, fall back can happen following a particularly lossy 
ground impact. Once fall back occurs, Chatur cannot raise itself owing to the torque 
limitation discussed in Section 2.5.1. At higher speeds, the ground impacts can be quite 
severe leading to large shocks on the rimless wheels that are capable of damaging it. Thus 


the range of achieved average speeds is limited at both ends. 


2.6.2 Calculation of average power and average velocity 


For a given set of waveforms obtained in any given regime, the average torque in a motor 
is given by 
Tg = ee ld; (2.38) 


where K; is the motor torque constant, J is the magnitude of the current pulse and 
d; is the duty ratio (temporal) of the current pulse. The average time interval between 


consecutive impacts gives the average stance phase duration (or average step duration, 7). 
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For step length /,, the average forward velocity is computed as 
ls 
Vz,avg = T (2.39) 


For leg length /, the average angular velocity of the rimless wheels is computed as 


Uz,avg 


Wavg = — (2.40) 


The average mechanical power including both motors is then calculated as 
Five =2- Tavg ‘avg (2.41) 


These calculations are carried out for various operating points (Table 2.3). The scatter 
plot of average power versus average velocity is shown in Figure 2.16. Non-dimensionalizing 
both quantities, the scatter plot for mechanical CoT (Pavg/mgvz,avg) versus normalized 
velocity (Vz,avg/ gl) is shown in Figure 2.17. The scatter plots use separate markers for 


the different regimes as indicated in the legend. R1—R4 denote regimes 1-4. 


2.6.3 Discussion 


Though the experimental set-up is built to emulate the mathematical model described 
in Sections 2.1-2.4, there are bound to be some deviations in practice. The ‘foot’ i.e. 
the end of a spoke is a finite sized rectangle (33 mm x 25 mm) as opposed to being a 
point. This affects the CoM trajectory and hence its total vertical excursion (Ah) in a 
stance phase. The type of foot — its shape, size and compliance — plays a key role in 
determining the ground impact losses. The losses are likely to be more complex than the 


simplistic models chosen (Equation 2.14). The loss parameters are not constant and have 
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Table 2.3: Measurements from experimental waveforms. 


EAS: 6). Sa ~ Tay, UN)? Ope (m/s) Wig (rad/s) Pang (W) 

Regime 1, dj, = 3/8 

10 0.50 0.60 3.60 0.40 0.70 o.1 

10 0.54 0.40 2.40 0.37 0.65 3.1 

8 0.60 0.45 2.16 0.33 0.58 2.5 
Regime 2, d;, = 4/8 

10 0.47 0.58 3.48 0.43 0.75 5.2 

10 0.53 0.59 3.04 0.38 0.66 4.7 

10 0.52 0.60 3.60 0.38 0.67 4.9 

9 0.50 0.58 3.13 0.40 0.70 4.4 

8 0.53 0.57 2.74 0.38 0.66 3.6 

7 0.73 0.59 2.48 0.27 0.48 2.4 

7 0.62 0.62 2.60 0.32 0.57 2.9 

7 0.88 0.53 2.23 0.23 0.40 1.8 

7 0.63 0.62 2.60 0.32 0.57 2.9 

6 0.75 0.61 2.20 0.27 0.47 2.1 
Regime 3, d;, = 5/8 

8 0.36 0.70 3.36 0.56 0.97 6.5 

7.5 0.41 0.71 3.20 0.49 0.86 5.0 

6.5 0.51 0.70 2.73 0.39 0.69 3.8 

6.5 0.55 0.73 2.85 0.36 0.64 3.6 

0.67 0.69 2.48 0.30 0.52 2.6 

0.58 0.72 2.59 0.35 0.61 3.1 

Regime 4, d;, = 8/8 = 1 

0.35 1.00 4.80 0.47 1.00 9.6 

0.51 1.00 3.00 0.39 0.69 4.1 

4.5 0.46 1.00 2.70 0.43 0.76 4.1 

3.9 0.60 1.00 2.10 0.33 0.58 2.5 

0.70 1.00 1.80 0.29 0.50 1.8 

0.75 1.00 1.80 0.27 0.47 1.7 
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wide variations in a practical scenario. There is a lot of distributed mass in the entire 
set-up as opposed to a lumped mass at the axle. The rimless wheels have some mass 
distributed away from the center. This results in a non-zero radius of gyration (rgy,) of 
the wheel thus requiring some internal energy (Ejn¢) to rotate it as well as altering the 
inverted pendulum dynamics. The heavy batteries are hanging below the axle taking the 
CoM of the system a few centimeters below the axle. The castor wheel (not present in 
mathematical model) faces some rolling resistance and can alter the dynamics. All these 


are non-idealities that can be further considered to extend the proposed model. 


2.7 Conclusion 


This chapter proposed the existence of four torque regimes in a rimless wheel based 2D 
walker actuated at the hub by pulsed torque. The four regimes are categorized based 
on the relative magnitudes of energy losses and actuator torque which in turn dictates 
the portion of the stance phase for which actuation is required. A closed-form analytical 
solution for the 2D dynamics of an inverted pendulum walker is presented which is also 
applicable for the rimless wheel with zero radius of gyration. An experimental prototype 
called Chatur is built using two contralateral rimless wheels and the four regimes are 
experimentally validated. The mechanical power as well as cost of transport is computed 
for all operating points. Pulsed torque of constant magnitude has been considered in this 
work. More generic walkers can have time varying actuator torques. But the basic idea of 
actuation being present over a certain angular displacement of the stance leg still holds. 
Hence the proposed torque regimes with the defined repeating cycles can be observed in 


all walkers — engineered or biological. 


2.7. Conclusion 
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Chapter 3 
Analysis of Operating Point Space 


Taking mass, leg length, braking torque and available actuator torque as fixed parameters, 
the operating point of an inverted pendulum walker can be specified by the combination of 
initial mid-stance velocity (vj) and step angle (@,,) chosen for a given walk. The analysis 
in this chapter builds on the inverted pendulum model and investigates its implications 
on the choice of operating points for a bipedal walker. Using basic mechanics, Section 3.1 
proposes a framework of physical constraints that define the valid region of operating 
points. Section 3.2 proposes an optimal locus of operating points (within the valid region) 


that tries to minimize the mechanical power expended for a given forward velocity. 


3.1 Constraints and limits 


Not all combinations of initial mid-stance velocity vg and step angle ¢, are realizable. 
This section explains all the physical constraints that limit the region of valid operating 


points for the inverted pendulum walker. 


3.1.1 Take-off constraint 


If the bob of an inverted pendulum moves too fast, it no longer stays on the circular 
trajectory shown in Figure 2.2c ie. it takes off. Usherwood (2005) argues that even 
when the mid-stance speed equals \/gl, at larger fall angles the CoM is bound to go away 
from its nominal trajectory (arc of radius equal to leg length). This is because as the 


angle increases, the component of gravity along the leg reduces while the velocity and 
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Figure 3.1: Take-off constraint lines for various leg lengths and no actuation (¢@, = 0). (a) is 


a reproduction of the plots in Usherwood (2005) mapped to the vo-¢m plane. 


hence the required centripetal acceleration increases. Accordingly, the take-off constraint 
can be specified in terms of the maximum possible step angle for any average forward 
velocity (Usherwood, 2005; Usherwood et al., 2008). Take-off happens when centripetal 


acceleration equals the component of gravity along the stance leg. 
2 
v 
7 = 9008 @ (3.1) 
In the limiting case, take-off happens right at the end of the fall i.e. at 6 = @,,. At that 
instant, the centripetal acceleration is given by 
2 
Uv 
ra = 9 COS dm (3.2) 
The take-off constraint for an ideal lossless inverted pendulum can be obtained by sub- 
stituting Equation 3.2 in Equation 2.2. Substituting instead in Equation 2.5 gives the 


take-off constraint line in presence of braking. 
ve = gl(3.cos dm + 2bm sin by — 2) (3.3) 


Figure 3.la plots the take-off constraint lines for various values of | for the lossless un- 
actuated fall. Figure 3.1b plots the same with braking loss included. Operating points 
below these constraint lines guarantee no take-off. Actuation has not been considered 
here as the fall of the CoM is typically unactuated. In case of an actuated fall, the take-off 


constraint lines will move lower down. 


There is another equivalent interpretation of the take-off constraint. As the inverted 
pendulum falls, the compression in the leg keeps reducing. At the instant the compression 
becomes zero, the ground will need to start pulling the leg. This is not possible (unless 
the foot is stuck on the ground due to some adhesive or suction pads) and hence the 


inverted pendulum takes off. 
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Figure 3.2: Sliding constraint lines for various values of coefficient of static friction (jis). 


3.1.2 Sliding constraint 


Taking large steps (large step angles) can lead to sliding. This is why one takes smaller 
steps while walking on a slippery surface like ice or wet floor. The static friction force 
is proportional to the vertical component of the ground reaction force. Since the rod 
is massless, the ground reaction force (F,,) acting at the bottom of the rod equals the 
compressive force (F..) in the rod because of the weight of the bob pressing on it 


mv? 


Fo = fF, = mg cos — > (3.4) 


As the inverted pendulum falls, the vertical component of the ground reaction force 
keeps decreasing while the horizontal component keeps increasing. At the instant when 
the horizontal component equals the maximum static friction available, sliding occurs. 


In the limiting case, the maximum step angle equals that at which sliding occurs. 


PF op sin Om = Pel an COS Om 
SF .=0 or. oy Stan "p, (3.5) 


where U, is the coefficient of static friction between the foot point and the ground. Zero 
ground reaction force is equivalent to zero compression in the leg and has already been 


dealt with as the take-off constraint. Hence, the sliding constraint is formulated by 
On = ten “pi, (3.6) 


Figure 3.2 shows the sliding constraint lines for a few different values of w;. They are 
superimposed on the take-off constraint line (no braking) for reference. Operating points 


below the sliding constraint line ensure no sliding. 
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Figure 3.4: Steady-state constraint lines for various leg lengths. 


3.1.3 Fall-back constraint 


The inverted pendulum walker just averts falling backwards if, following a ground impact, 


the inverted pendulum reaches mid-stance at zero CoM velocity. In this limiting case, 
application of conservation of energy gives 


1 
<mv? + dmmgl sin dg — dmmgl sin dy = mgl(1 — cos bm) (2:7) 


2 
Um = 2gl(1 — coSdm — bmbe) (3.8) 


Using Equations 2.5, 2.11 and 3.8, the fall back constraint is obtained in terms of wg 
and ¢m. It is plotted for a few different values of parameters in Figure 3.3. Choosing 


operating points below these constraint lines makes sure that the walker does not fall 


back. 


3.1.4 Steady-state constraint 


Given an actuator torque, certain combinations of vg and @¢,, lead to a scenario where 


the losses are too high for the actuator to compensate within one stance phase (Case 5 
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Figure 3.5: vo © vm constraint lines for 1% and 0.1% difference between vp and vm. 1 = 1m 


and ¢@p = 0 


in Section 2.4). The actuation provided is not enough to sustain the gait. The walker 
keeps slowing down to lower and lower mid-stance speeds at each subsequent step till the 
losses equal the energy that the actuator can impart in one stance phase (the operating 
point moves to a regime 4 steady-state walk). To avoid such a situation, the actuation 
should be at least enough to attain a steady state walk by the next ground impact. In the 
limiting case, the actuation is just enough to maintain steady state (regime 4). Neglecting 
internal energy, the expression for E’pnase in Equation 3.11 reduces to the expression for 
Fioss in Equation 2.14. Substituting Equation 2.14 into Case 4 in Section 2.4 yields 

v2, = Ponte (3.9) 

sin* 20, 

Plugging Equation 2.5 into the above equation gives the steady-state constraint line in 
terms of vg and @,. Figure 3.4 plots the steady-state constraint lines for few differ- 
ent values of parameters. All operating points on the steady-state constraint line yield 
regime 4 walking. Only operating points on or below this line lead to steady-state walks 


(no slowing down). 


3.1.5 up & v», constraint 
For very small ¢,, and reasonably high values of vp, two undesirable effects are observed. 


1. Since the variation in CoM height (Equation 1.7) is negligible, hardly any energy is 
transformed from potential to kinetic. The CoM velocity uv, at the end of a stance 
phase is almost equal to the mid-stance CoM velocity vo. This situation is like 
the case of the synthetic wheel (Section 1.4.3) but with very large internal energy 


requirement because of high step frequency. 


2. Sub-phase and stance phase durations become very small and can be of the same 
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order as the computation time step while solving for the dynamics of the walker. 


This can lead to appreciable errors in the computation of Uz,avg and Poyg. 


Because of the impractically high internal energy requirement and for ease of computa- 
tion, such operating points may be avoided. Accordingly, a v9 © vm constraint line is 
obtained after solving the dynamics of the walker for various operating points. Figure 3.5 
shows these constraint lines for 1% and 0.1% difference between vp and v,,. They are 
superimposed on the take-off constraint line (no braking) for reference. Operating points 
above the vp & Um constraint lines have a larger difference between vp and v,, and are of 


interest for us. 


3.2. Optimal walker 


Once the limits on the choice of operating points are defined, the next logical step is to look 
for optimal operating points that prescribe the best way to walk. This requires choosing a 
suitable cost function and a method to compute and then minimize it. Section 1.2 justifies 


choosing mechanical power consumption as the cost function for engineering applications. 


3.2.1 Computation of average power and average velocity 


For an inverted pendulum walker using a compass gait with alternating legs, in addition 
to overcoming losses (Equation 2.14), some energy needs to be spent to move and place 
the finite mass swing-leg at every step (Hint). At normal walking speeds, this energy 
might be much smaller than the losses. But at fast walking speeds, the contribution 
due to internal energy is likely to dominate. The swing leg can be modelled as a simple 
pendulum of mass mjeg and effective length /,,,. The internal energy is the energy required 


to drive this simple pendulum and can be derived from basic mechanics. 
Pang = 8MieglayPa dt? (3.10) 


where f is the step frequency. For humans, the leg mass is about 10% of the body 
mass. The effective length of the swing leg can be taken as 0.5/. A higher duty factor 
implies lesser time available for driving the swing leg and hence higher F;,,, than that in 
Equation 3.10. In the case of a rimless wheel, the distributed legs configuration reduces 
the internal energy requirement as there is no swing leg that needs to be driven and 


placed in time for the next step. Ejos, and Ej, need to be delivered continuously to the 
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walker throughout a steady gait. Mechanical energy supplied to the walker in a stance 
phase is 
Pe ieae ae Pigas ar cone (3.11) 


Note that different muscles/motors could be used to supply the Fj,;, and En, portions. 


The average mechanical power is given by 


E ase 
Pung = ae (3.12) 


where the stance phase duration (7) is computed by adding all the sub-phase durations 
(Tsp; Equation 2.32) in the given regime. Taking m, g, |, ¢, and ¢, as fixed parameters, 


Pavg is a function of two variables vp and ¢,,. In abbreviated notation 


aig = filvo, dm) (3.13) 


Similarly, the average forward velocity is also a function of these two variables. 


21 sin dm, 
Vz,avg = T = fo(vo, Ons) (3.14) 
Thus, vg and @¢,, are the controllable variables that decide the average forward velocity and 
the average rate of mechanical work done for a steady walk. Both non-linear functions, 
fi and fe, can be visualized in the form of contour plots for a given set of parameters 
(Figures 3.6a,b). 


3.2.2. Minimum mechanical power for inverted pendulum walker 


Any chosen operating point results in a particular value of average forward velocity Vz,avg 
and average mechanical power consumption P,,,. Figure 3.6a shows the vz,q,g contour 
plot for m = 65 kg, g = 9.81 m/s’, l= 1m, ¢, = 10° and @ = 1°. Each contour 
represents all possible combinations of vg and ¢, that give the same value of Uz,avg- 
Figure 3.6b shows the contour plot for Pa ,g for the same parameter values as above. 
Here, each contour represents combinations of vg and ¢,, that give the same value of 
Pavg. From the contour plots note that both Payg and Uzavg are a lot more sensitive to 
variation in vp than they are to variation in ¢,,.. The envelope of the contour plots is 


bounded by the constraint lines discussed earlier. 


A particular value of average forward velocity vzayg can be achieved by choosing any 
of several combinations of vp and ¢,,. One of these combinations results in the least 


mechanical power consumption and can be considered the optimum operating point for 
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(c) Optimal operating point for a given (d) Family of optimal operating points 
average forward velocity. gives the optimal locus. 
Figure 3.6: Average velocity and average power contours and construction of optimal locus. 


Parameters: m = 65 kg, 1 = 1m, dg = 10° and ¢@ = 1°. 


the given Uz,avg- To find the optimal operating point, the lowest valued Py,, contour — 
the one that is tangential to the given v;q,, contour — needs to be found. The point of 
tangency gives the optimal operating point (Figure 3.6c). Any other operating point on 


the given Vz,avg contour has a higher mechanical power requirement. 


Similarly, one can find the optimal operating points corresponding to increasing values 
of Veavg till one hits any of the constraint lines (Section 3.1). The family of optimal 
solutions thus obtained constitutes the optimal locus (Figure 3.6d). Choosing operating 
points on this locus ensures that the walker expends the minimum possible mechanical 


energy for all realizable speeds. 
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Figure 3.7: Regions of operation for ] = 1m and ¢@, = 1°. R1—-R5 correspond to regimes 1-5. 
The grey region indicates valid operating points that result in steady-state walking (regimes 
1-4). The red region indicates operating points in regime 5 that result in a walk that keeps 
slowing down till the operating point reaches the regime 4 line. A higher actuator torque (b) 


results in a larger valid region of operation. 


3.3. Results 


3.3.1 Regions of operation 


Figure 3.7a illustrates all the constraint lines (as derived in Section 3.1) for 1] = 1m, 
oq, = 10° and @ = 1°. Superimposing all the constraints, the valid region of operation 
for the inverted pendulum walker is obtained. Only operating points within this region 


are physically realizable. 


Case 2 in Section 2.4 gives the regime 2 line (lower dashed line in Figure 3.7a). 
Operating points on this line correspond to regime 2 walking. It is the boundary between 
operating regions that yield regime 1 and regime 3 walks. Operating points on the steady 
state constraint line correspond to regime 4 walking (upper dashed line in Figure 3.7a). 
This line forms the boundary between regions of operating points that belong to regime 3 


and regime 5. Regimes 1-4 give steady-state limit cycle walking. 


The actuation torque plays a major role in defining the fall-back, steady-state and 
Up & Um, constraint lines and hence needs a closer look. Humans and several robots with 
finite-sized feet have actuated ankles. The vertical ground reaction force (GRF) acting on 
the foot of the trailing leg during the push-off (at double support) provides the actuation 
torque (see Figure 2.5). The point of application of this force is about a step length 


3.3. Results 58 


behind the stance foot thus providing a mechanical advantage. 
Ta © (vertical GRF) x (step length) (3.15) 


The average value of the vertical GRF over the double support duration is a function 
of the duty factor (3). A typical value is about 70% of the body weight i.e. 0.7mg. 
Taking a typical step length (/,) of 0.7 m, this amounts to a torque of about 0.5mg acting 
on the inverted pendulum. This implies ¢, ~ 30° for humans (substitute / = 1 m and 
T, = 0.5mg in Equation 2.16). For such a high value of @,, the fall-back and steady-state 
constraint lines are pushed out beyond the take-off constraint line to regions of invalid 
operating points from a take-off perspective (Figure 3.7b). Hence, the valid region of 
operation is now bounded only by take-off, sliding and vp © vu, constraint lines. Only 
walking regimes 1, 2 and 3 are possible. For even higher actuation torques, only regime 1 


walking is possible. 


Humans, on account of having a relatively high actuator torque, have a larger valid 
region of operation (Figure 3.7b). Humans with emaciated calf muscles and robots with 


motors of low torque capability can have a smaller region of operation (Figure 3.7a). 


With ankle actuation, going from regime 1 to higher regimes requires increasing the 
double support duration. This reduces the time available for the swing leg to be raised 
and placed for the next step. Hence, regimes 4 and 5 (continuous actuation) cannot be 
achieved since that would leave no time for driving the swing leg. Only operating points 
farther away from the steady state constraint line can be realized because of internal 
energy limitations. With hip actuation, it is possible to get continuous actuation albeit 


without the mechanical advantage. 


3.3.2 Optimal loci 


As the leg length is varied, the optimal loci (as derived in Section 3.2) obtained from 
the model are found to overlap when vp is normalized by \/gl (Figure 3.8a). For a broad 
range of actuation torques (10° < ¢, < 50°), the shape and location of the optimal loci 
remains largely similar. With changing @¢,, the loci shift up or down within a couple of 
degrees of each other. The optimal loci upto a non-dimensional speed of 0.7 have largely 
constant step angles. Thus choosing the right step angle and keeping it fixed over a broad 
range of speeds could lead to an inverted pendulum walker with minimum mechanical 
energy consumption. Chapter 4 describes the design, construction and working of Chatur 


— a fixed-¢,, 2D walker implemented using rimless wheels. 
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Figure 3.8: Effect of changing / on optimal locus and the corresponding Py,, and mechanical 


cost of transport. Parameters: m = 65 kg, g = 9.81 m/s”, dba = 10° and dy = 1°. 


Figure 3.8b plots the Pa, Versus Uz,qyg assuming the walker always chooses operating 
points on the optimal locus. Figure 3.8c plots the corresponding mechanical cost of 
transport (Equation 1.4) for this optimal inverted pendulum walker. Larger leg lengths 
lead to smaller mechanical CoT for any given speed. Dividing v;., by gl, the non- 
dimensional average forward velocity is obtained. Plotting the mechanical CoT versus 
this normalized v;,ayg (Figure 3.8d), almost overlapping curves are obtained irrespective 


of leg lengths. 


Smaller step angles lead to lesser impact losses. But they warrant larger step fre- 
quencies that increases the internal energy requirements. Conversely, larger step angles 
lead to lower Ej, but higher Ejo;,. The shape and location of the optimal locus in the 
Uo-Om plane is a result of the trade-off between Ejo,, and Fjny. Hence, the accuracy of the 


models for losses (Equation 2.14) and swing leg actuation (Equation 3.10) play a key role 
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in defining the optimal locus correctly. The internal energy requirement changes when 
taking into account the fact that the time available for the swing leg to be driven goes on 
reducing as one goes from regime 1 to regime 4. Also if the configuration of the inverted 
pendulum walker is a rimless wheel instead of a compass, the internal energy required is 
much smaller as there is no swing leg to actuate. Springy legs reduce impact losses and 
shift the optimal locus upwards. Lighter legs reduce the internal energy requirement thus 


shifting the optimal locus downwards. 


The inverted pendulum walker modelled here is quite lossy and hence has relatively 
higher mechanical CoT compared to human walking. Humans store part of the impact 
energy in elastic tendons on the front side of the shin. For a man-made inverted pendulum 
walker, adding compliant elements to store and release the impact energy reduces the 
mechanical power requirement. This shifts the optimal locus upwards to larger step 
angles as is typically observed in humans (15°-25°). However, it should be noted that 
human walking gait optimizes for metabolic energy and not mechanical energy. Hence, 
even with reduced impact losses, the inverted pendulum walker can have a different 
optimal locus compared to human walking. Experimental measurements (Cavagna et al., 
2000) show that the step lengths (and hence the step angles) for humans increases from 


0.5 m to 0.9 m with walking speed increasing from 0.5 m/s to 2 m/s. 


3.3.3 Discussion 


The constraint lines and optimal loci on the vp-¢m plane can be easily mapped to the 
Uz,avg-ls and f-l,; planes by using known relations between the quantities. The operating 
point of the walker can also be specified by the combination of steady state mid-stance 
velocity (vos) and step angle (@m). Voss can be lower than vp if the actuation torque 
is too low. Assuming that the actuation torque is high enough to achieve steady state 


within the second ground impact, the vos, is either equal to or uniquely related to vo. 


3.4 Conclusion 


The operating point of the inverted pendulum walker is specified by a combination of 
initial mid-stance velocity and step angle chosen for a given walk. A framework of physical 
constraints that limit the choice of operating points is proposed. Five physical constraints 


that delineate the valid region of operation are presented. These constraints impose 
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fundamental limits on the walking. For any given speed, the optimal operating point 
that ensures minimum mechanical energy expenditure, based on tangency of the power 
and velocity contours, is proposed. Applying the proposed method to different speeds, 
the locus of optimal operating points is obtained. The shape and location of this optimal 
locus is sensitive to the models chosen for loss and internal energy. Using an appropriate 
constant step angle over a broad range of speeds could lead to an inverted pendulum 
walker that is close to optimal. This optimality is different from the optimality based on 


minimum metabolic cost. 


3.4. Conclusion 
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Chapter 4 


Hardware Design 


and Control Topology 


This chapter describes the hardware design and proposes a control topology for pulsed 
torque actuation of a dual-rimless-wheel based 2D walker named Chatur. A characteristic 
feature of this class of mechanical loads is that the reflected torque has a cyclic variation 
that repeats several times within a mechanical revolution. The torque pulse tries to 
put in just the right amount of energy to maintain the forward motion of the mobile 
platform. Continuous actuation with constant torque is a special case where the duty 
ratio of the pulse is 100%. Section 4.1 details the design and construction of the complete 
hardware set-up of Chatur. Section 4.2 describes the design and implementation of the 
proposed control scheme for pulsed torque actuation of Chatur ensuring synchronization 
of the rimless wheels. The BLDC motor drive uses non-commutating current feedback to 
reduce current spikes during sector transitions. Section 4.3 shows experimental waveforms 


that validate the working of the proposed controller. 


4.1 Hardware design 


Chatur is a fixed step-angle dynamic walker implemented using the rimless wheel ap- 
proach. The CoM kinematics and dynamics of a rimless wheel with zero radius of gyra- 
tion is similar to that of an inverted pendulum walker. In both cases, the CoM traces 
a trajectory consisting of a series of arcs (shown in dashed lines in Figure 1.6a,b). The 


spoke length of the rimless wheel is equivalent to the leg length of the biped. The inter- 
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spoke angle is equivalent to the inter-leg angle of the compass walker at foot-strike and is 
twice the step angle (Figure 1.6b). The distance between the far ends of two consecutive 
spokes signifies a side of the rolling polygon and stands for the step length of the biped. 
Since the spokes are spaced at constant angles, this rimless wheel based walker cannot 


vary its step angle unlike the more dextrous biped using alternating legs. 


Each time a new leg is to be placed on the ground, the rimless wheel makes it easily 
possible because of its distributed legs configuration. This avoids the need to drive a 
swing leg fast enough to be placed in time for the next step. Hence, the rimless wheel 
approach leads to a lower internal energy requirement compared to a compass gait with 


alternating legs. 


A single rolling rimless wheel can fall sideways. To ensure lateral stability two con- 
tralateral rimless wheels are used (see Figure 4.2) each driven by a separate BLDC hub 
motor. It is effectively a walker with an actuated hip joint. There is no mechanical 
advantage and hence the motor torque requirement is higher compared to foot actuation. 
In order to ensure fidelity with the 2D inverted pendulum model, both the rimless wheels 
need to move in synchronism. The foot point of each leg of a rimless wheel should hit the 
ground exactly as its counterpart on the other wheel. By synchronizing the two wheels, 
motion is limited to the sagittal plane making it a 2D walker. Actuation can be either 


pulsed or continuous by energizing the motor accordingly. 


4.1.1 Mechanical subsystem 


The mechanical subsystem comprises the two rimless wheels, a welded mild steel (MS) 
frame and enclosures for the onboard electronics. No attempt is made to reduce weight of 
the system, so that the heavy parts, such as MS frame (7 kg) and sealed lead acid (SLA) 
batteries (15 kg), can emulate some payload weight. All the CAD drawings/renderings 
are given in Appendix B (Section B.1). 


Rimless wheels 


Figure 4.1 shows the construction of a rimless wheel with a BLDC hub motor as the 


actuator (Figure 4.1a). The reasons for choosing a hub motor are threefold: 


1. The bearings are designed to take lateral shocks as the target application of these 


motors are electric scooters and electric assist bicycles. 
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(a) Brushless dc hub motor 


(c) Teak wood spoke with rubber ‘foot’ (d) Assembly of all three parts 


Figure 4.1: Construction of a rimless wheel. 


2. The outer rotor allows for easy construction of the wheel without the need for a 


transmission. The spokes can be directly attached to the outer rotor. 


3. These motors are capable of low speed, high torque operation. 


Eighteen equidistant spokes at 20° intervals are attached to the outer rotor of the 
hub motor. Initially, aluminium spokes were explored. But owing to unavailability of 
aluminum extrusions of required dimensions, wooden spokes are used (457 mm x 33 mm 
x 25 mm, Figure 4.1c). The spokes are attached to the rotor via mild steel annular 
discs using M4 nuts and bolts (Figure 4.1d). The annular discs are fabricated using laser 
cutting (Figure 4.1b; CAD drawing Figure B.1). Rivet nuts, as opposed to normal hex 
nuts, are used to reduce the stress on the bolt threads. MS washers are used to prevent 
brinelling of the annular disc. Spring washers are used to prevent the loosening of the 
joints due to vibrations on impacts. The distal ends of the distributed legs (spokes) have 


rubber ‘feet’ in order to reduce impact vibrations and losses. After assembly, each rimless 
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(a) Version-1: slotted angle frame. 


(b) Version-2: welded mild steel frame. 


Figure 4.2: Full mechanical assembly of Chatur excluding enclosures for onboard electronics: 


two contralateral rimless wheels and frame with attached tail piece. 


wheel weighs 12 kg. 


Frame 


The first version of the frame (chassis) was built using mild steel slotted angles (Fig- 
ure 4.2a). Availability of several slots providing a flexibility in modifying the frame size 
was the chief reason for choosing slotted angles. Joints between slotted angle members 


were made using corner plates and M7 nuts/bolts. 


When energized, the motors try to rotate the wheels and a counter torque acts on the 
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stators which are attached to the chassis. To prevent this counter torque from rotating 
the frame rather than the wheels, a tail piece is introduced (Figure 4.2). The bottom end 
of the tail has a small castor wheel resting on the floor. The ground reaction force on 
the castor helps resist the counter torque on the frame. An alternate design without the 
tail piece is possible by using a counterweight (located away from the axle) on the frame 
(Robotics-Unlimited, 2014). The top plate of the castor wheel needs to be horizontal in 
order to avoid undesirable yawing torques that try to turn Chatur to the left or right. 
Initially, a swivelling castor wheel was used. But any lateral component of the ground 
reaction force on the castor wheel resulted in appreciable yawing torque on Chatur. 


Hence, it is replaced with a normal non-swivelling castor wheel. 


The first version of the frame had the following problems: 


1. Wheel alignment: the planes of the rimless wheels were not parallel (they had 


some camber and toe-in) resulting in a large reflected torque on the motor. 


2. Wobbling wheels: lack of stiffness in the slotted angle members resulted in a 
flimsy frame. The planes of the rimless wheels kept wobbling leading to dynamics 


very different from that of a 2D rimless wheel. 


3. Assembly issues: attaching the rimless wheel to the frame was cumbersome be- 


cause of inaccessibility of the nuts on the inner side. 


In order to overcome the above short-comings, a second version of the frame is de- 
signed and constructed using precision welded mild steel angles (Figure 4.2b). This frame 
consists of three parts: (i) axle or main frame, (ii) battery carrier and (iii) tail piece and 


castor wheel assembly. 


Figure B.2 shows the CAD drawing of the main frame. It is made of 35 mm L-angles 
of 5 mm thickness. The two motors are attached to this part by placing the stator axle 
of the hub motor in the 11 mm slots provided and then fastening using nuts. Figures 
B.3-B.5 show the CAD drawings of the battery carrier (along with the main frame). It 
is made of 20 mm L-angles of 3 mm thickness. Figure B.6 shows the CAD drawing of 
the tail piece. It is made of rectangular MS pipe (40 mm x 20 mm; 2 mm thickness). 
Figure B.7 shows the CAD drawing of the full assembly of the frame. 
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Figure 4.3: Block diagram of electrical subsystem. 
Enclosures 


An aluminium enclosure (Figure B.8) is designed for housing the power and control 
electronics. A polycarbonate enclosure (Figure B.9) is designed for housing the terminal 
block where connections are made between the batteries, motors, manual switches, fuses 
and heat-sink fans. Both the enclosures along with the electronics sit on top of the main 


frame. 


4.1.2 Electrical subsystem 


The block diagram of the complete electrical subsystem — energy source, actuators and 


electronics — is shown in Figure 4.3. 
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Table 4.1: Specifications of sealed lead acid batteries (CSB GP1272). 


Parameter Value 
Voltage 12 V 
Ampere-hour 7.2 Ah 
Mass 2.4 kg 


Dimensions 150 mm xX 95 mm Xx 65 mm 


Energy source 


The energy source is a set of SLA batteries (specifications in Table 4.1). Two batteries 
in series give 24V nominally. Two such pairs provide the dc links for the inverters that 
drive the two motors. One more pair is used to power the control electronics. Thus, six 
batteries are used in total. Fuse protection (20 A, 20 A, 0.8 A) is provided for each of 
the pairs. 


Actuators 


Each of the two wheels is actuated by a three-phase BLDC hub motor (specifications in 
Table 4.2). The torque constant (A‘,) and winding inductance (L_ = Ly = L, = Lp) and 
resistance (Ra = Ry = R. = Ryn) are determined experimentally by conducting blocked 
rotor tests. Figure 4.4 shows the set up for measuring the stalling torque using a digital 
weighing scale and known lever arm. The measurement of torque constant has a 10% 


tolerance owing to the torque variation in the motor with change in rotor position. 


A hall effect position sensor built into the motor gives the rotor position as a 3-bit 
digital output. Within each electrical cycle, the sensor gives six different position outputs 
or sector numbers. For the 25 pole pair motor, this translates to a mechanical position 
resolution of 2.4°. The sequence of sector numbers is 5—4—6—2-3-—1 for counter-clockwise 
rotation (CCW; Table 4.3) and is used for the right motor on Chatur. The reverse 
sequence gives clockwise (CW) rotation and is used for the left motor. At any instant, 
only two of the three phase windings of the BLDC motor carry current while the third 
one is left unused. This leads to six possibilities as shown in Figure 4.5. Each of the 
six current directions leads to a different stator mmf space vector orientation which the 
permanent magnet rotor tries to catch up to (Figure 4.6b). Table 4.3 shows the winding 


current commutation sequence for CCW rotation. CW rotation is achieved by reversing 
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Parameter Value 
Power 300 W 
Voltage 24 V 
Current 12A 
Pole pairs 25 


Torque constant (K,) 0.6 Nm/A 
Phase resistance (Rpn) 0.35 Q 
Phase inductance (Lp,) 0.12 mH 
Mass 5.2 kg 


Table 4.2: Specifications of BLDC motor. Figure 4.4: Block rotor test of BLDC motor. 


Sector no. Motor current Inverter state 
direction A B Cc 


. CA 
(101). =5 A+B- sw 0 x BA. 
(100). =4 ATC” sw x 0 yy Ww 
(110). =6 Bro x sw 0 AB a 
(010). =2 Bray 0 sw x B a, C 
(iijg=3 CtA- 0 x sw “Bic 
(001). = 1 CTB- x 0 sw 


Table 4.3: Commutation sequence (CCW rotation) of BLDC mo- Figure 4.5: Current di- 
tor. sw = switching, 0 = clamped to 0, x = both switches OFF. rections of BLDC motor 


the current direction for each sector. 


Electronics 


The power electronics circuitry consists of two CIPOS™* based three-phase inverters to 
drive the two BLDC motors. The signal electronics circuitry comprises sensing, signal 
conditioning and control circuits that reside in a PSoC® 5% based printed circuit board 
(PCB) called Chatur controller board. The complete circuit schematics for both the 
boards are given in Appendix B (Section B.2). 


*Control Integrated POwer System from Infineon 
tProgrammable System on Chip from Cypress Semiconductor 
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Figure 4.6: (a) Circuit schematic of three phase inverter and BLDC motor. (b) Stator mmf 


orientations and rotor positions over one electrical cycle. 


(a) CIPOS™ inverter board. (b) Chatur controller board. 


Figure 4.7: PCBs designed for Chatur: power and control electronics 


CIPOS™ inverter board: This board? (Figure 4.7a) is based on the reference design 
given in Infineon’s application note (JunBae Lee and Chung, 2010). The specifications of 
the board are listed in Table 4.4 and its circuit schematic is given in Figure B.10. It uses 
the CIPOS™ Integrated Power Module (IKCS22F60AA). This module is a conventional 
three-phase inverter along with gate drive circuit for all six Insulated Gate Bipolar Tran- 
sistors (IGBTs) in one package. The board has a comparator based circuit for generating 
a fault signal in case of over-current or over-temperature. The current trip value is set 
at 15 A. The inverter is operated at a switching frequency of 16.33 kHz which yields 
a PWM cycle time of 61.2 jus (less than one-fifth of the motor winding time constant, 
Lpn/Rpn & 350us). To prevent shorting of the dc link, a dead time (3 pus) is provided 
between the turn-OFF of a switch and the turn-ON of its complementary switch on the 
same inverter leg. Cooling for CIPOS"™ is provided by an off-the-shelf force-cooled heatsink 
(with attached fan) typically used for any Socket-478 CPU (Pentium-4/Celeron). 


*Designed during the author’s M.Tech project at IISc, Bangalore (Patnaik, 2009, chap. 13) 
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Table 4.4: CIPOS™inverter board specifications. 


Inputs (1) 24 V de link, 12 A 
(2) Power supply for gate drive (15 V) 
and fault detection circuit (5 V) 
(3) Six PWM control signals for the IGBTs 


Outputs (1) Three pole voltages of the inverter 


(2) Fault indication to controller 


Dimensions 87 mm xX 37mm x 1.6mm 


The circuit schematic in Figure 4.6a shows the connection of the inverter and BLDC 
motor. Viz. denotes the 24 V dc link coming from battery. The reference directions of the 
phase currents (J,, J, and I.) are indicated. The winding back EMF's (F,, Fy and F,) can 
be neglected (< 1 V) for the low speed operation (< 10 rpm) in the present application. 
For CCW rotation of motor, the inverter switching states in the six sectors are indicated 
in Table 4.3. ‘sw’ indicates that the corresponding inverter leg is switching between V4, 
and 0 V with a duty ratio set by the torque controller (see Section 4.2.1). ‘0’ indicates 
that the inverter leg is clamped to 0 V i.e the bottom device is ON and the top device is 
OFF. ‘x’ indicates that both the switches in the inverter leg are OFF. 


Chatur controller board: This board is a custom PCB designed for controlling 
Chatur (Figure 4.7b). The design is carried out using the open source gEDA tool suite. 
The specifications of the board are listed in Table 4.5. The top-level block diagram 
and the circuit schematics of the board are given in Figures B.11—-B.15. This board 
houses the PSoC® 5 microcontroller (CY8C5568) and its peripheral circuits in addition 
to the circuits for housekeeping power supply, sensing, signal conditioning, communica- 


tion, opto-isolation, and other miscellaneous tasks. 


Sensors for motor currents, battery voltages, rotor-position and an accelerometer are 
provided. Four hall effect current sensors (LEM LTS25NP) are used for sensing phase 
currents of both motors (Jq1, [o1, Lag and Iy2). Each current carrying wire makes six turns 
around the current sensors giving a sensitivity of 150 mV/A. The third phase current (I¢1 
and [,9) is left unmeasured as it can be derived from the other two phase currents. 
Provision for sensing battery voltages — using resistive divider followed by isolation 
amplifier — is available on the board but is left unused. Since the built-in position 


sensors of the BLDC motor are of open-collector type, they need pull-up resistors that 
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Table 4.5: Chatur controller board specifications. 


1) Power 


24 V, 0.6 A power supply (for flyback) 


Inputs ) 
a) 


b) 5 V aux. power supply (unused in present work) 


( 

( 

( 

(2) Sensing 

(a) Motor currents (a1, pi, Jag and [y2) 
(b) Battery voltages (Vie: and V4.2) 
( 

( 

( 

( 

( 


c) Rotor positions (83-bit digital output from each motor) 


3 


a 


) Others 
) JTAG programming and debugging interface 
b) Remote control signal from RF transmitter 


c) Fault indication from inverters 


Outputs Six PWM control signals for each inverter 


Dimensions 190.5 mm x 146.9 mm x 1.6 mm 


are provided on the Chatur board. A MEMS accelerometer (MMA7331) is used to detect 
the ground impacts. When used in the 4g sensitivity range, it gives 363 mV/g. Signal 
conditioning for each of the analog sensor outputs comprises a second order Sallen-key 


low pass filter (cut-off frequency 723 Hz) for anti-aliasing. 


A radio frequency communication link is provided for an operator to send in com- 
mands. Off-the-shelf 433MHz ASK transmitter (TX) and receiver (RX) modules are used 
in conjunction with the UART within PSoC®. Both ends use 19 cm monopole antennae. 
The transmitter sends a moving average filtered version of the motor torque reference set 
by a sliding potentiometer. Only the receiver resides on the Chatur board. The trans- 
mitter is implemented using the ASK TX module and a general purpose PSoC board’. 
Caveats: (1) Even though nominally equal clock frequencies are used at TX and RX, 
care should be taken to use same valued load capacitors on the crystals on both ends, 
else the frequency at TX can be slightly off from that at RX leading to communication 
errors. (2) A silent period of about 5 ms is added between consecutive samples to avoid 


the wrong bit being taken as start bit. 


PWM pulses (from Chatur board to CIPOS™boards) and fault signals (from the 


8Designed by Sudharshan Kaarthik, the author’s lab-mate 
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Table 4.6: Specifications of flyback power supply. 


Input 23-27 V, 0.6 A 


Outputs (1) 5V, 0.3A (for all circuits on control side ground) 
(2) 5V, 0.3 A (for low voltage circuits on power side ground) 
(3) 15V, 0.3A (for CIPOS™ gate drive) 


Switching frequency 100 kHz 


CIPOS™boards to Chatur board) are opto-isolated! (using 6N137). Potentiometers, in- 
dicator LEDs, push-button switches and pull-downs for current DACs (of PSoC®) are 
provided for testing and debugging purpose. PSoC® programming is done through a 
10-pin JTAG interface using the MiniProg3 programmer. 


The power supply for Chatur board is a multi-output flyback converter (Mohan et al., 
2005; Umanand, 2009). It also supplies for the gate drive circuit and the fault detection 
circuit on CIPOS™board. It has three isolated outputs and switches at 100kHz. The cir- 
cuit schematic for the power supply is given in Figure B.15. A PWM controller (UC3845) 
generates the gate pulses for the MOSFET (IRF540). An RC snubber is used for protect- 
ing the MOSFET against voltage spikes at turn off. The flyback transformer is wound on 
a 36/22 ferrite pot core. SWG26 enamelled copper wire is used. The MATLAB /octave 
script for designing the flyback transformer is given in Listing B.1. Each output winding 
of the flyback transformer is followed by an LC filter, a common-mode choke and a linear 
regulator. Specifications of the flyback power supply are given in Table 4.6. Caveats: (1) 
Even though the chosen core size and shape is correct, the ferrite material used should 
be capable of 100 kHz operation. Otherwise high core losses can lead to the flyback 
transformer running hot. (2) Common mode noise at the output needs to be reduced by 
using an inter-winding shield in the flyback transformer and a common-mode choke at 


each output. 


‘During early stages of testing, the controller board got burnt due to lack of isolation! 
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Figure 4.8: Electrical wiring diagram. 
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Figure 4.9: Full system after integration. Chatur is a fixed step-angle 2D dynamic walker 
implemented using two contralateral rimless spoked wheels. Each wheel is actuated by a BLDC 
hub motor with 18 equidistant spokes attached to the outer rotor. The frame contains the 
batteries and the electronics for power, control and measurement. A battery-operated four- 


channel oscilloscope is mounted onboard to capture waveforms. 
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4.1.3 System integration 


Figure 4.8 shows the electrical wiring diagram of the complete system with connector 
details. Since the system is subjected to vibrations that could loosen friction based 
connectors, automobile grade locking connectors are used for the power and signal con- 
nections between motor and the PCBs. The mechanical and electrical subsytems are 
integrated to form the full mobile robot system called Chatur. The effective spoke length 
(1; from center of motor to end of spoke) is 0.57 m and the inter-spoke angle (2¢,,,) is 20°. 
The full system mass (m) is about 50 kg. After integrating the mechanical and electrical 


subsytems of Chatur, the full system is shown in Figure 4.9. 


4.1.4 Load and actuator torque profile 


The rated motor current (Imax) is 12 A and the motor torque constant (K;) is 0.6 Nm/A. 
Hence, the maximum actuator torque (combined effect of both motors driven by rated 
current) is given by 2ImarK;, = 14.4 Nm. If the motor is at zero velocity at the lowest 
potential energy position, it needs a raising torque of mglsind,, = 48.5 Nm. Hence, 
Chatur cannot raise itself from stand still in this position. Owing to this torque limitation 
of the motor, initial raising of the CoM is done manually and waveforms are taken for 


steady state forward motion. 


Typical motor drive systems deal with mechanical loads that are defined in terms 
of three components: (1) A load torque term (7;) obtained from the torque-speed static 
characteristics, (2) A dynamic torque term (J a that accounts for the rotational accel- 
eration overcoming inertia, and (3) A speed-dependent loss term (Bw) that accounts for 
viscous friction losses. The mechanical load on the motor in this rimless wheel system, 
unlike in a conventional wheel system, has a load torque that varies with the angle made 
by the stance spoke with the vertical (mglsin@). Also, unlike typical loads, the system 
has the capability to convert its gravitational potential energy to kinetic energy because 
of which it is possible to actuate the system with a torque magnitude much smaller than 
the peak load torque. Figure 4.10 depicts the load and actuator torque profile for one 
stance phase with an inter-spoke angle of 20° (inset). The same profile is repeated eigh- 
teen times in one mechanical revolution of the rimless wheel. Though the system is not 
self starting, once the CoM is manually raised, the actuator torque pulse just needs to 


overcome the losses in the system to keep it going forward. 
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Figure 4.10: Torque profile for the opposing load torque (7) of the rimless wheel varies 
sinusoidally with angular position of the stance spoke with respect to vertical. The present set- 
up uses an inter-spoke angle (20°). The resulting variation of the load torque and the pulsed 
actuator torque (7,) over one stance phase is shown inset. The same pattern repeats eighteen 


times in one mechanical revolution of the motor. 
4.2 Control topology 


This section proposes a control topology for Chatur and describes its implementation 


using the PSoC® 5 controller. The control scheme has two hierarchical levels: 


1. Inner loop: torque control of BLDC motor 


2. Outer loop: torque reference generation 


Each of these tasks is implemented using hardware blocks in conjunction with embed- 
ded software running within the PSoC®. Hence, the control scheme implementation 


comprises two parts: 


1. A top-level schematic that configures blocks of digital and analog resources available 
within PSoC®. 


2. A control algorithm (an embedded software) that. runs on the ARM core of PSoC®. 


The PSoC® port map as applicable on Chatur board (Table B.1), the top level PSoC® 
schematics for the project (Figures B.16—B.19) and the C-code for the control algorithm 
(Listing B.2) are provided in Appendix B. 
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Figure 4.11: Block diagram of inner loop of control scheme: torque control of brushless dc 
motor. The duty ratio (d) input to the PWM block is the inverter pole voltage duty ratio 
(different from the pulsed torque duty ratio.) 
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Figure 4.12: Block diagram of the full control scheme: inner loop (torque controller) and 
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outer loop (torque reference generation). 


4.2.1 ‘Torque control 


The heart of the control scheme is the torque control of the BLDC motor shown in 
Figure 4.11 (Patil et al., 2009). Since it is a permanent magnet motor'!, torque control 
can be achieved by controlling the stator current. Based on the sensed rotor position, the 
torque feedback value is calculated from the sensed phase currents (Figure 4.13) and the 
right pair of windings are excited as per Table 4.3. Thus in each 60° (electrical) sector, 
the BLDC motor can be treated as a DC motor. The current control is done using a 
Proportional-Integral (PI) controller. Figure 4.11 shows the block diagram of the torque 


control loop for one BLDC motor. The second motor too has a similar control structure. 


The outer rotor is embedded with permanent magnets 
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The PI controller gains (A, and K;) are tuned using Ziegler Nichols method. Care 
is taken to avoid integrator wind-up by latching the integrator output once it reaches an 
upper limit. The PI controller output is limited to avoid large duty ratios that could lead 
to higher than rated currents. The PWM block uses a ramp compare method to generate 
the gating pulses of the required duty ratio. The logic block (Logic-2) after the PWM 
block decides which pair of windings to excite and which to leave unused based on the 


sensed rotor position. 


A hardware based method is employed for inverter fault checking. The fault signal 
coming from CIPOS™board is passed through a glitch filter followed by a latch the output 
of which gates all the PWM outputs. Software based fault checking (polling, interrupts) 
should be avoided as it is slow and unreliable. Spurious trips caused due to noise on the 
fault signals are eliminated by using hardware glitch filters (glitch length 4.9 ws). Noise 
issues could also introduce glitches in sector identification. These glitches are eliminated 
by using a hardware glitch filter (glitch length 600 pus) in PSoC®. 


4.2.2 Current feedback 


Figure 4.13 illustrates the nominal current waveforms (neglecting switching frequency 
artifacts) for a three phase BLDC motor. Typically, the time constant of the current rise 
and fall is a much smaller fraction of the sector dwell time than what is indicated in the 


figure. 


Taking a commutating phase current as the torque feedback leads to current over- 
shoots at sector transitions. This is because the feedback value is low during the commu- 
tation when the current magnitude is still rising. The controller tries to correct for this 
perceived drop in torque leading to a spike in current that can trip the inverter. Hence, 
the phase current that best conveys the information of the motor torque is the one that 
is not commutating in the sector transition. The torque feedback is thus reconstructed 
from the non-commutating current in each sector. Various position sensorless current 
commutation techniques exist for BLDC motors (Chen and Liaw, 1999; Chi et al., 2013). 
But most of these methods rely on the sensed back emf which is very low (< 1 V) and 


hence unusable in the present application. 


Figure 4.14 depicts the strategy used for obtaining the motor currents once in every 
PWM cycle. The measured motor currents (J, and J,) obtained from the current sensors 
are relayed to an 8-bit SAR ADC through an analog multiplexer available within PSoC®. 


81 4,2. Control topology 


sector | 5 4 6 2 4 1 sector 3 2 6 4 5 i 


number | number 
| 


Tp 


Tp -Te +1a —Iy +e |—Ia +1 


(a) CCW rotation (b) CW rotation 
Figure 4.13: Reconstructing torque feedback (Jf) from BLDC motor phase currents. At each 


sector transition, the magnitude of the non-commutating phase current is taken as Iyp. 


The multiplexer alternately switches between J, and J, every 30.6 ps (half of the PWM 
cycle time). It can have a finite settling time after a channel switch happens. Hence, the 
start-of-conversion to the ADC is given after the multiplexer switches to a new channel 
and stays there for 15.3 ys (half of the channel dwell duration of the multiplexer). The 
start-of-conversion to the ADCs in PSoC® needs to be a level (maintained throughout 
the conversion) and not just an edge**. The ADC completes conversion in 10 ys and 
writes the 8-bit words for the sensed currents into designated registers through DMA 
transfer, without interrupting the processor. This helps save processor cycles thus reduc- 
ing software loop time. This method is used for getting J, and [, of both the motors (two 
separate ADCs). 


The ARM processor picks up the latest digital words corresponding to the non- 
commutating current from the registers once every software cycle. It then rectifies, 
level-shifts, scales and filters it in order to get a torque feedback value. Rectification 
is required as the sensed current is negative in certain sectors. Level shifting gets rid of 
the DC offset of the sensor. Scaling translates the 8-bit value to a 16-bit current feedback 
value in 4.12 fixed point format. Filtering eliminates switching and high frequency noise 


artifacts from the measured current. It comprises a glitch filter followed by an exponen- 


**This discrepancy resulted in wrong ADC output values in an early version of implementation. 
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Figure 4.14: Strategy for obtaining motor currents once in every PWM cycle. 


tial moving average filter. This glitch filter checks if difference between two consecutive 
samples is too large to be physically possible and retains the old sample value if so. The 
delay in sensing introduced due to the moving average filter should not be too large, 
else the current can reach its trip value before the controller could act. In Figure 4.11, 
the logic block (Logic-1) after the current sensors incorporates all the above tasks for 


computing the current feedback depending on the sector number. 


4.2.3. Torque reference generation 


In order to obtain a pulsed actuation torque, the torque reference (J,,¢,) needs to be 
shaped depending on the intended regime of walking and the corresponding spatial duty 
ratio. For instance, in case of regime 2 walking, a positive step in J;e¢ is introduced at 


ground impact and then reduced back to zero upon reaching mid-stance. 


The accelerometer output (a_) is checked at the start of each software cycle. Whenever 
a, crosses a threshold, a ground impact is detected and a positive step is introduced in [;¢. 
The magnitude of the torque step is set internally or controlled by the operator via the 
radio control. Depending on the intended regime of walking, [ef is reduced back to zero 
after the desired number of sector changes in motor position. Between two consecutive 
impacts, the wheel (and hence the motor) sweeps through 20°. As sector change in 
position sensors happens every 360°/(25x6)=2.4°, there are eight sector changes in a 
stance phase. The processor keeps track of the number of sector changes following an 
impact and uses this information to time the removal of the torque pulse. For instance, a 
nominal regime 2 walk requires the removal of the torque pulse after four sector changes 


following a ground impact. This gives a spatial duty ratio (d;,) of 4/8 i.e. 0.5. 
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Table 4.7: Time scales of various events/processes. 


Description Time 
ADC conversion time 10 ps 
PWM cycle time 61.2 ps 
Software loop time 100 pus 
Motor L/R time constant 350 jus 
Sector dwell time 30-120 ms 
Double impact blindfold window 300 ms 
Step duration 350-900 ms 


Figure 4.12 shows the block diagram of the full control scheme. The reference value 
commanded by the operator is used as the step size of the torque pulse. The select line 
for the multiplexer controls the torque duty ratio and hence the regime of walking. The 
multiplexer output is filtered (exponential moving average) before being passed on as the 


torque reference. 


Chatur’s steady state speed settles at the value where the energy losses equal the 
energy put in by the actuator. The losses are likely to change from step to step because 
of physical asymmetries and non-uniformities in inter-spoke angle, shape of the foot point 
and hardness of the surface of travel. Hence, the steady state speed is only nominally 
constant. Large variations in speed can be compensated for by manually changing the 


reference value sent via radio control. 


4.2.4 Wheel synchronization 


Owing to practical asymmetries, there is a possibility of the two wheels going out of sync. 
In such a case, the ground impacts of corresponding spokes on the two wheels are time 
displaced leading to a double impact as opposed to a single impact (see Figure 4.17b). 
In such a case, the number of sector changes in a stance phase is smaller for one motor 
and larger for the other. In the subsequent stance phase (duration between two ground 
impacts when the rimless wheel vaults over one spoke), the motor that is lagging is given 
a slightly higher torque reference and the one that is leading is given a corresponding 
lower torque reference. Wheel synchronization is achieved in this way. The scaling factor 


(K sync) for the wheel sync term is tuned by trial and error. 


The flowchart for the full control scheme of Chatur is given in two parts in Fig- 
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ures 4.15—-4.16. Immediately following a ground impact, a double impact blind-fold win- 
dow (300 ms) is introduced. During this interval the processor is blind to any further 
impacts. This ensures that the second impact in a double impact event is not interpreted 
as a fresh ground impact that resets the sector change counts. The software loop time 
can vary (80-90 jus) due to ‘if’ and ‘case’ statements in the code. Varying software loop 
time changes the effective controller gains. Hence, the loop time is fixed to 100 ps by 
using a timed interrupt. After all the computation in a software iteration is done, the 
processor remains in a WAIT state till the periodic interrupt arrives. Only then is the 
the next iteration resumed. The time scales of the various events/processes in the system 
are collated in Table 4.7. 
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NOTE: 
1. Initial raising of Chatur's CoM is done manually. 
2. Motor current values (la1, Ib1, la2, Ib2) and acceleration value (az) are obtained through DMA 


3. ‘flag’ is set to CALC by a 100us loop timer ISR 
4. lag = (sector change count of other motor) — (Sector change count of one motor) 
5. d_is = parameter that defines duty ratio of current (in space) 


START 


y 
Define and initialize all variables and parameters 


y 
Initialize all peripherals: UART, IDACs, DMAs, ADCs, PWMs, ISRs 


y 
Get motor positions (from hall sensors): 
secnolold = ? 
secno2old = ? 


(Between ground impacts; 
also before first ground impact) 


NO 


az>2.2V? 


YES (at ground impact) 


Y NO : 
Increment impact_cnt J 
NO 
y vy 
Read UART RX data Read UART RX data 
ref = UART_ReadRxData(); ref = UART_ReadRxData(); 
v Y 
Check for RF fault to confirm reception of correct ref value Check for RF fault to confirm reception of correct ref value 
y v 
Scale ref to get Irefs: Scale ref to get Irefs: 
lrefl = ref*k1 lrefl = ref*k1 
lref2 = ref*k2 lref2 = ref*k2 
y 
Read step_timer value 


(Subsequent ground impacts) 


(First ground impact) 
v 


Restart step_timer 


y 
Start step_timer = p 
Read step_timer value pistes ie = ale ies i oe 
hange_cnt1 = 0 ref2sync = Iref2sync + Ksync*lag; 
pegs -ent2 = sec_change_cnt1 = 0; sec_change_cnt2 = 0 
sec_change_cnt2 =0 i 


lrefl=lrefi+lreflsync 
> lref2=lref2+lref2sync 
Limit lref1 and Iref2 to 11A 


! 
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Figure 4.15: Flowchart of full control scheme (1/2). 
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ES 
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Get motor positions (from hall sensors): 
secnol = ? 
secno2 = ? 


’ 


secnol changed? 


Increment sec_change_cnt1 
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Increment sec_change_cnt2 


sec_change_cnt1>d_is? 
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sec_change_cnt2>d_is? 
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y 


EMA filter Irefs © <— 


: 


Rectify, level-shift, scale and filter measured currents: 
lfblavg = ? 
Ifb2avg = ? 


’ 


Generate proper duty ratios using PI control algorithm: 
d1 = Pl_control(Iref1,lfb1avg) 
d2 = Pl_control(Iref2, Ifb2avg) 


Activate PWMs in appropriate phases (based on sector no.) 


x) (y) 


L A Send debug waveforms to IDAC (for diagnostics) A 


’ 


flag = WAIT Save history flag = WAIT 


NO 


YES 


(Double impact blindfold window) 


Step_timer>BLINDFOLD_CNT? 


Figure 4.16: Flowchart of full control scheme (2/2). 
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4.3 Experimental results 


This section gives the experimental results in terms of the working of the control scheme 
— torque control, wheel synchronization and steady state forward motion of Chatur — 


using suitable waveforms. 


At the instant of ground impact, detected by an impulse in the accelerometer output 
(Figure 4.17a), the torque reference is raised to a value set by the operator. The torque 
reference is brought back to zero after a predefined number of sector changes following 
the ground impact. The waveforms show that the torque feedback tracks the torque 


reference. One of the motor phase currents is also shown for reference. 


Figure 4.17b illustrates a double impact identified by a double impulse in the ac- 
celerometer output. Owing to a finite lag between the two motors, the wheel synchro- 
nization loop kicks in to change the torque references of the two motors (see Figure 4.12) 
thus bringing the wheels back in sync on subsequent ground impacts. The torque duty 
ratio in this set of waveforms is kept at 100% (continuous actuation; regime 4) to make it 
easier to notice the dip in the torque reference of one of the motors. The sector number 
of motor-1 is seen to follow the cyclic sequence 5—4—6-2-3-1 (CCW rotation). The wave- 
forms for steady state forward motion of Chatur in all four torque regimes are depicted in 
Section 2.6. Waveforms for two different average speeds achieved by changing the torque 


duty ratio are reproduced here (Figure 4.17c,d). 
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:double ‘impact; 


dip.in torque": 
: reference = 


(a) Torque control: torque feedback is seen (b) Wheel sync: double impact causes a dip 


tracking the pulsed torque reference. in torque reference for one motor. 


(c) Duty ratio<0.5, vayg = 0.33 m/s. (d) Duty ratio>0.5, vavg = 0.49 m/s. 
Figure 4.17: Waveforms validating the working of the control scheme: (a) pulsed torque 
control, (b) wheel synchronization, (c,d) steady state forward motion of Chatur. Scales: (a) 
(1) Accelerometer output: 2 V/div, (2) Motor phase current: 10 A/div, (3) Torque reference: 
0.5 V/div, (4) Torque feedback: 0.5 V/div, time scale: 100 ms/div. (b,c,d) (1) Accelerometer 
output: 2 V/div, (2) Motor-1 sector number, (3) Motor-1 phase current Igi;: 10 A/div, (4) 
Torque reference: 1 V/div in (b,c) and 2 V/div in (d), time scale: 250 ms/div. 


4.4 Conclusion 


This chapter describes the hardware design and proposes a control topology for pulsed 
torque actuation of two BLDC hub motors in a dual-rimless-wheel walker with a char- 
acteristic cyclic variation in reflected load torque. Experimental waveforms validate the 
working of the control scheme in terms of torque control, wheel synchronization and 
steady state forward motion of the mobile robot. An improved BLDC drive is used that 
reduces current overshoots during sector transitions by using non-commutating current 
feedback. The magnitude and duration of the applied torque pulse is programmable by 


the user and enables attainment of various steady state speeds. 


Chapter 5 
Conclusion 


This chapter summarizes the research contributions in terms of the key findings and their 
implications. The scope for further work is also suggested in the mathematical as well as 


physical models. 


5.1 Summary of contributions 


1. Closed-form analytical solution for stance phase dynamics of inverted 
pendulum walking: A simple closed-form analytical solution, using hyperbolic 
functions, is proposed for the stance phase dynamics of 2D inverted pendulum 
walking. In addition to gravity, constant actuation and braking torques expressed 
in a parametric form, are taken into account. The proposed solution (analytical) 
approximates the exact one (numerical) within 6% upto a step angle of 25°. On 
account of being analytical, as opposed to numerical, the proposed solution is a 
useful tool for investigating the effect of various parameters and variables on the 


stance phase dynamics of any inverted pendulum based walker. 


2. Torque regimes in a rimless wheel based walker using pulsed torque 
actuation: A pulsed actuation torque is proposed for the rimless wheel based 2D 
dynamic walker resulting in four torque regimes defined by the ratio of energy losses 
to available actuator torque. Higher the losses, more the pulse duty ratio required 
for a steady-state walk. A stance phase can have four types of sub-phases — un- 
actuated rise, unactuated fall, actuated rise, actuated fall. These are concatenated 


in four different ways to form repeating cycles yielding the four regimes. This work 
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considers pulsed torque of constant magnitude. More generic walkers can have time 
varying actuator torques. But the basic idea of the actuation being present only 
for a portion of the stance phase still holds. Hence the proposed regimes with the 


defined repeating cycles can be observed in all walkers — engineered or biological. 


3. Framework of physical constraints on the choice of operating points in 
inverted pendulum walking: The operating point of the inverted pendulum 
walker is specified by a combination of initial mid-stance velocity (vg) and step angle 
(dm) chosen for a given walk. Not all operating points lead to a realizable steady- 
state gait. Using basic mechanics, a framework of physical constraints that limit 
the choice of operating points is proposed. These constraints are the fundamental 
limits on walking like an inverted pendulum. The constraint lines thus obtained 
delimit the valid region of operation of the walker in the vp-@, plane. Within this 
allowable region, sub-regions that result in various regimes of walking are identified. 
The magnitude of the available actuation torque affects the shape and size of the 
valid region of operation. Operating points of all inverted pendulum walkers must 


fall within this valid region. 


4. Optimal operating points in inverted pendulum walking: For any given 
speed, the optimal operating point that ensures minimum mechanical power con- 
sumption is located based on tangency of the power and velocity contours. Re- 
peating for different speeds, the locus of optimal operating points is obtained. The 
shape and location of this optimal locus is sensitive to the models chosen for loss 
and internal energy. Using an appropriate constant step angle over a broad range 
of speeds could lead to an inverted pendulum walker that is close to optimal. This 
optimality is different from the optimality based on minimum metabolic cost and 


is more relevant for engineered walkers rather than biological walkers. 


5. Hardware design and control topology for pulsed torque actuation of 
a synchronized dual BLDC motor driven platform: The hardware design 
for the mechanical and electrical subsystems of Chatur are elaborated. To avoid 
falling sideways, the system uses two adjacent wheels driven by separate BLDC hub 
motors. The reflected load torque has a characteristic cyclic variation repeating 
several times within a mechanical revolution. The proposed control topology has 
two hierarchical levels, an inner loop for torque control of BLDC motor, and an outer 
loop for torque reference generation. Ground impacts of the spokes are detected 


by an accelerometer to initiate the application of torque. Wheel synchronization is 
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achieved by incrementing the torque of the motor that is lagging. The BLDC motor 
drive uses non-commutating current feedback to reduce current spikes during sector 
transitions. The proposed control topology, with suitable ad hoc modifications, can 


be used in other synchronized dual motor systems with pulsed actuation. 


5.2 Scope for further work 


Mathematical model 


1. A unified mathematical model for walking and rolling needs to be arrived at. Sub- 


stituting a step angle of zero in the model should produce the model of a rolling 
wheel of radius equal to the chosen leg length. To make such a model possible, a 
particular type of surface of travel and type of foot has to be assumed. The stance 
phase during walking involves rolling over the stance foot as the center of pressure 
moves from the toe-end to the heel end of the foot. A suitable rolling resistance 


model needs to be devised that holds for walking as well as rolling. 


. The model presented in this work neglects the contribution of the internal energy 


(Eine) to the dynamics and considers its effect only on the energetics. Effect of 
distributed mass, as opposed to a lumped mass, needs to be incorporated in the 
mathematical model. Consequently, the effect of E;,, on the dynamics of the walker 


can be investigated. 


Experimental model 


1. Losses need to be reduced in order to make the experimental prototype more energy 


efficient. The impact losses can be reduced by designing a suitable compliance into 
the leg. The braking losses can be reduced by better wheel alignment (lesser toe-in 
and camber) and by using motors with lower detent torque. Actuators with high 


efficiency in the low speed region (0.4—10 rad/s i.e. 4-10 rpm) need to be used. 


. The experimental model needs to be augmented with the ability to start from stand- 


still. This can be done by increasing actuator torque or introducing some mechanical 
advantage. One solution is to use actuated feet as opposed to hip actuation. That 
would require a large number of motors (one per spoke) of lower torque rating. 
Another solution is to use spokes of variable length which again requires additional 


linear actuators. 
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3. In order to avoid the undesirable effects of the castor wheel on the dynamics of the 
system, the tail piece needs to be done away with. Reducing the overall system 
weight and using a suitably positioned counterweight on the stator can help in this 


regard. An additional benefit is the ability to walk forward as well as backward. 


4. Chatur is a fixed step-angle dynamic walker owing to the constant inter-spoke 
angle of the rimless wheel. A mechanism of varying the step-angle needs to be 
incorporated. This will enable spanning a larger set of operating points in the vo- 
om plane raising the possibility of an optimal walker that always tries to be on the 


optimal locus as discussed in Section 3.2. 


5. Instead of keeping the rimless wheels in sync, it is possible to achieve straight line 
walking with two rimless wheels that are phase displaced in their motion. The 
spokes of the left and right wheel would hit the ground alternately bringing the 
model in closer resemblance to a 3D walking biped. To enable this, the distance 
between the wheels has to be smaller than that in the present set-up. The walker 
will sway from side to side i.e. there will be some lateral dynamics which will have 


to be taken into account. 


6. The present work investigates the dynamics and energetics of 2D motion. With the 
rimless wheels moving at different speeds, it is possible to achieve turning albeit 
with large reflected torque on the actuators. The dynamics and energetics of turning 
needs to be investigated and suitable techniques to achieve it with minimal energy 


expenditure needs to be developed. 


Appendix A 
Jansen Mechanism 


Theo Jansen designed a planar linkage mechanism that mimics the leg motion pattern of 
a walking mammal (Figure A.1). It is a 12-link mechanism including a crank link that 
is actuated by a rotary actuator and a stationary link that is part of the chassis of the 
legged system. The stationary link — between the crank center and a pin joint — is 
shown in dashed line and is inclined at an angle of 11.6° to the horizontal. All other links 
and joints are unactuated and move because of the motion imparted by the crank. Their 
positions and orientations are uniquely defined by specifying the crank angle and hence 
the mechanism has only one degree of freedom (1-DoF). The link lengths as designed by 


Jansen are given in Table A.1 where the link numbers are as shown in Figure A.2a. 


A.1l Forward kinematics 


Determining the motion of every point on the mechanism from known geometry is called 
forward kinematics. Points where the links are pin jointed are referred to as nodes. Using 
circle intersection method, Ingram (2004) determined the trajectories of various nodes 
(Figure A.2a) and link CoMs (Figure A.2b) in the chassis reference frame. The foot point 
trajectory forms a closed shape whose horizontal extent gives the step length and vertical 


extent gives the step height (Figure A.2c). 


The end of the crank (node-0) and the foot point (node-5) trace their respective 
trajectories in the same sense. If the crank rotates clockwise, the foot point also traces 
its trajectory clockwise while the knee joint (node-4) goes anti-clockwise. In presence of 


a number of such legs in a walker, the landing and take-off points are annotated on the 
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Table A.1: Link lengths in Jansen leg mechanism in proportion to crank length. 


Link Length 
Link-0 (crank) Ip = 1.00 
Link-1 i= 3:30 
Link-2 i312 
Link-3 l3 = 2.63 
Link-4 Il, = 4.38 
Link-5 lg = 3:27 
Link-6 Ig = 4.13 
Link-7 l7 = 2.45 
Link-8 lg = 2.62 
Link-9 lo = 2.77 
Link-10 Lip = 2:67 


Link-11 (fixed) U4; = 2.59 


foot point trajectory. The foot point trajectory is almost flat between the landing and 
take-off points. Changing the frame of reference from the chassis of the walker to the 
ground, the trajectory of the crank center is quite flat. Hence the trajectory of the walker 
CoM (located in the chassis) is also flat. 


In order to have a variable step length, one more degree of freedom needs to be added 
to the Jansen mechanism. This can be done by making any one of the links have a variable 
length by introducing a linear actuator in the link. The step length in Jansen mechanism 
is not very sensitive to change in the length of the stationary link. The effect of changing 
crank length on step length and step height is plotted in Figure A.2d. The variation in 
step length (/,) with crank length (lo) is found to be linear and is approximated by the 
following equation. 

I, = Alp + 0.5 (A.1) 


(a) crank angle = 0°. (b) crank angle = 36°. (c) crank angle = 72°. (d) crank angle = 108°. (e) crank angle = 144°. 


(f) crank angle = 180°. (g) crank angle = 216°. (h) crank angle = 252°. (i) crank angle = 288°. (j) crank angle = 324°. 


Figure A.1: Jansen leg mechanism at various crank angles. 
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(a) Node trajectories. (b) Link CoM trajectories. 


Maximum foot height point 
-Y 


Step height = 1.5 


Landing point(}) 
—— ~* 


Step length = 4.5 


(c) Step length and step height. 


01 02 03 04 05 O06 O07 O08 O9 1° 14 
Crank length 


(d) Step length and step height with varying crank length. 


Figure A.2: Trajectories of various points in Jansen leg mechanism and obtaining step length 


and step height from the foot point trajectory. Crank length = 1 for (a), (b) and (c). 
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A.2 Inverse dynamics 


Determining internal forces and/or torques from the given motion of the elements and 
known external forces is called inverse dynamics. In order to obtain the design specifica- 
tions of the motor and the links in the Jansen mechanism, inverse dynamics needs to be 


carried out assuming the crank rotates at a constant angular speed. 


The dynamics of linkage mechanisms can be modelled using bond graphs (Karnopp 
and Margolis, 1979; Karnopp et al., 1990; Diwakar, 1996). The bond graph model for 
each link comprises multiport modulated transformers (mTF) that transform the forces 
at the ends of the links to forces acting on the link CoM and/or torques acting on the 
link. They also transform link end velocities to link CoM velocity and/or link angular 
velocity. The modulation coefficients in an mTF are a function of the angular position 
(variable) of the link and the geometry (fixed) of the link in terms of the relative position 
of its CoM with respect to the point of application of the force. 


The simple links in Jansen mechanism — links 0, 1, 3, 6 and 8 — are assumed to 
have their CoM at the mid-point of the link. When three links form a triangle, it is a 
fixed structure incapable of relative motion between the links. Such links are considered 
as composite links — link 2-9-10 and link 4-5-7 — with their CoM located within the 
triangle. Let the frame of reference be fixed on the chassis as in Section A.1. Some of 
the links in Jansen mechanism — link 0, link 8 and link 2-9-10 — undergo pure rotation 
about a fixed point (Figure A.3). Their CoM trajectories are arcs of fixed radii. The 
bond graph model of such links is shown in Figure A.4. The other moving links — links 
1, 3, 6 and link 4-5-7 — undergo rotation as well as translation (Figure A.5). The bond 
graph model of such links is shown in Figure A.6. If a link is subjected to more forces, 
further mTF's need to be added to these link models to incorporate the effect of those 


forces. 


The interaction between the links happens at the pin jointed ends of the links. Putting 
together the models for all the links and that for a constant speed motor at the crank, the 
bond graph model for the complete mechanism is obtained (FigureA.7). Note that the 
joints between links are modelled as stiff springs with damping (compliance, C = 107°; 
damping resistance, R = 0.001). This takes care of causality issues in the model. Some 
of the mTFs are not shown (between links 1 and 6; between links 4-5-7 and 6) in the 
figure for ease of viewing. All the bonds are numbered for ease of referencing. The 


angular velocities of links-0, 1, 2, 3, 4, 6, 8 are integrated with respect to time to obtain 
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Figure A.3: Links undergoing pure rotation. 
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Figure A.4: Bond graph model for links undergoing pure rotation. 


the respective angular displacements qi, qi6, 933, 61, ize, Yor and qiio (numbering as 
per bond numbers, not link numbers). Angular speed and hence displacement of links-9 
and 10 are same as that of link-2. Angular speed and hence angular displacement of 
links-5 and 7 are same as that of link-4. The mTF coefficients are given by the following 


equations. 


M, = Mg = |—to sing, Ig cos a| (A.2) 
10 4sing 
My = | oo | (A.3) 
0 1 =F 008 dig 
10 —4sing 
M3 = | i i (A.4) 
0 1 cos qi¢ 


M,= |—ty sin q33_ Ig cos ass| (A.5) 
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oe |—ho sin(q33 — 86.27°) tip cos( qa — 86.27°)| (A.6) 
10 —&8sing 
Mz = | - ‘ (A.7) 
0 1 $cosgei 
10 sing 
i | ae | (A8) 
Q 1 — cos qeéi 
10 —“sing 
Mg = | - : (A.9) 
0 1 3 cosqoi 
10 “sing 
Mi = | a ve | (A.10) 
QT = 2 cosgsi 
Mi _ Mie = E sin 4110 —lg COS quo] (A.11) 
M. i 1 0 —l, sin(qi26 + 83.4°) (A 12) 
= ‘ 
“10 1 lycos(quag + 83.4°) 
1 0 —Is si 
Mae 5 SIN 9126 (A.13) 
0 1 Is cosqia6 


The constant angles used in Equations A.6 and A.12 are obtained from the geometry 
of the two composite links. Since all the elements in the bond graph model can be mapped 
to typical electrical circuit elements, the entire model can be mapped to a SPICE netlist 
and then simulated. The initial angular positions of all the links are obtained from 
the kinematic analysis in Section A.1 assuming the crank starts at an angle q, = 0 
(horizontal). The vertical component of the ground reaction force (GRF) is modelled as 
per Equation 1.5 (A = 200 N and gq = 1/6). The horizontal component is approximated 
as a second harmonic (of amplitude A/7) of the fundamental chosen in Equation 1.5. 
This GRF is applied to the bond graph model at the foot point as it traces the part of its 
trajectory between the landing and take-off points. Figure A.8 shows the time variation 
of GRF (vertical and horizontal components), reflected motor torque and link angular 
positions. Based on the peak value of the reflected motor torque, the torque specification 


of the motor is obtained. 
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Figure A.5: Links undergoing rotation and translation. 


oe 


Figure A.6: Bond graph model for links undergoing rotation and translation. 
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Bond graph model of Jansen Mechanism 
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Figure A.8: Time variation of GRF (vertical and horizontal components), reflected motor 
torque and link angular positions for Jansen mechanism. A = 200 N, gq = 1/6, crank length 


lo = 0.05 m, link density = 1 kg/m, motor angular speed = 7 rad/s. 


Appendix B 


CAD Details 


This appendix contains the complete CAD details for the mechanical and electrical sub- 


systems of Chatur. 


B.1 Mechanical subsystem: AutoCAD drawings 


e Annular disc that couples the BLDC hub motor to the spokes 
e Chatur frame: axle (main frame) 

e Chatur frame: battery carrier (top piece) and axle 

e Chatur frame: battery carrier (bottom piece) 

e Chatur frame: battery carrier (full) and axle 

e Chatur frame: tail piece 

e Chatur frame: all parts 

e Enclosure for electronics 


e Enclosure for terminal block 
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Figure B.1: CAD drawing of annular disc that couples the BLDC hub motor to the spokes 
(two discs per motor). It is fabricated using MS sheet of 1.2 mm thickness. All dimensions are 


in mm. 


SIDE VIEW 
iS 
ive) 
fap) 
FRONT VIEW Mild Steel L-angle 
CHATUR FRAME PART-1 : AXLE g 
| Scale: 
[———— Author: Lalit Patnaik, DESE, IISc 
1.95 Date: January 2013 
} Ze -1 + All dimensions are in centimeters 


TOP VIEW 


50.00 


12.00 


Figure B.2: CAD drawing of Chatur frame: axle (main frame). 
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Figure B.3: 


CAD drawing of Chatur frame: battery carrier (top piece) and axle. 
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Figure B.4: CAD drawing of Chatur frame: battery carrier (bottom piece). 
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Figure B.5: CAD drawing of Chatur frame: battery carrier (full) and axle. 
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Figure B.6: CAD drawing of Chatur frame: tail piece. Castor wheel (not shown) is attached at the bottom as shown in Figure 4.2b. 


60T 


SSUIMeIP (VQo0ny ‘ulaysAsqns feorueyey ‘TI 


TOP VIEW 


SOUTH-EAST 
ISOMETRIC VIEW 


FRONT VIEW 


° 


fo| 


SIDE VIEW 


Figure B.7: CAD drawing of Chatur frame: all parts. Assembly is done using M7 nuts and bolts. 
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Figure B.8: CAD rendering of enclosure for electronics. The small green rectangles are the 
CIPOS inverter boards. The large green rectangle is the Chatur controller board. The blocks 
at the wall of the enclosure are the heat sinks. The slots on the opposite wall are for mounting 


the power switch and fuse for the controller board. 
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Figure B.9: CAD rendering of enclosure for terminal blocks. The terminal blocks are not 
shown in the figure. The enclosure has two open sides. The wires from the battery bank come 
in on one side. The wires to the inverters go out on the other side. The slots on the roof are 


for mounting the power switches and fuses for the inverter board. 
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B.2 Electrical subsystem 


e PCB Schematics 


— OrCAD schematics of CIPOS™ inverter board 
— gEDA schematics of Chatur board 


* Top level block diagram (top.sch) 

« PSoC® 5 and its peripherals (psoc.sch) 

*« Opto-isolation of PWM and fault signals (opto.sch) 
* Sensing and signal conditioning (sense.sch) 


*« Three output flyback converter (power.sch) 


e MATLAB /octave script for design of three-output flyback transformer used on 
Chatur board (flyback.m) 


e PSoC® port map as applicable on Chatur board 


e Top level PSoC® schematics 


Page-1: Fault servicing, position sensing and PWM generation for motor-1 
— Page-2: ADCs and UART 


— Page-3: Fault servicing, position sensing and PWM generation for motor-2 


Page-4: Timers and IDACs 


e C-code for the control algorithm (embedded software that runs on the ARM core) 
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Figure B.10: CIPOS™inverter board OrCAD schematics 
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Figure B.11: gEDA schematics of Chatur board: Top level block diagram 
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gEDA schematics of Chatur board: PSoC® 5 and its peripherals 


Figure B.12 
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Figure B.13 
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gEDA schematics of Chatur board: Three output flyback converter 


Figure B.15 
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% Flyback transformer 


(multi—winding 


inductor) design 


% Author: Lalit Patnaik, DESE, IISc 

% 

% Ref: ”Power Electronics — Essentials and Applications” 
% by L Umanand, pp. 379-383 

Vin-min = 23 

Vin-max = 27 

Dmin = 0.25 

Dmax = 0.5 

fs= 100e3 

Ip = 0.6 % (10V*0.3A+10V*0.3A+20V*0.3A) /23V 
del_Ip = 0.1 

Lp = Vin_max*0.4/(del_Ip*fs ) 


Ip-_max = Ip + del_Ip/2 


E_L = 0.5*Lp*xIp_max*2 
Kw = 0.3 

Ke = sqrt (Dmin) 

J = 4ce6 % 4 A/mm2 

Bm = 0.25 


Ap=2*E_L / (Kw* Kc J *Bm) 


% Choose core with higher Ap than that obtained above 


% and get the core specifications 


% For 


AL 
Aw 
Np 


ap 
Isl 
Is2 
Is3 
asl 


as2 


as3 = 


36/22 POT core: 

1000e-9 % AL is generally 
0.75e—4 

ceil (sqrt (Lp/AL) ) 


Ip/J 
0.3 
0.3 
0.3 % average 
Isl/J 
Is2/J 
Is3/J 


specified 


in nH/turns“2 


% Enter standard wire—guage cross—section areas: 
% SWG-22 0.397e-6 ; SWG—24 
% SWG-28 = 0.11lle-6 ; SWG-30 = 


ap = 0.1642e—-6 % SWG—26 
asl = 0.1642e-6 % SWG—26 
as2 = 0.1642e-6 % SWG—26 
as3 = 0.1642e-6 % SWG—26 
avl_Warea = Aw*xKw 


0.2454e—-6 
0.0779e—-6 


3 


SWG-— 26 


reqd_Warea = ap*xNp + asl*Np + as2*Np + as3*2*Np 


0.1642e—-6 


3 


Listing B.1: MATLAB /octave script for design of three-output flyback transformer. 
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Table B.1: PSoC® port map as applicable on Chatur board. 


PSoC® port Signal Description Available at 
PO|O Tal Sensed current CONNSB 

PO|1 Ib1 Sensed current CONNSB 

PO|2 Ta2 Sensed current CONNSB 

PO|3 Ib2 Sensed current CONN3B 

PO|4 Vdel Sensed voltage CONN3 

PO|5 Vdc2 Sensed voltage CONN3 

PO[6 IDACO DAC output CONN4 

PO|7 IDAC2 DAC output CONN4 

P1[0 JTAG-TMS JTAG CONNI1 

Pl{l JTAG-TCK JTAG CONNI1 

P1[2 CHAN SAR ADC channel select D201 (Green LED) 
P1[3 JTAG-TDO JTAG CONNI1 

P14 JTAG-TDI JTAG CONNI1 

P1[5 SOC SAR ADC SOC D202 (Green LED) 
P1|6 _ Push-button switch S4 

P1|7 RF_FLT RF fault D203 (Green LED) 
P2|0 hal Motor-1 hall sensor-a CONN7 

P21 hb1 Motor-1 hall sensor-b CONN7 

P2|2 hel Motor-1 hall sensor-c CONN7 

P2\3 ha2 Motor-2 hall sensor-a CONN8 

P2|4 hb2 Motor-2 hall sensor-b CONN8 

P25 he2 Motor-2 hall sensor-c CONNS8 

P2|6 — — — 

P2|7 = _ D204 (Green LED) 
P3/0 IDAC1 DAC output CONN4 

P3{1 IDAC3 DAC output CONN4 

P3/2 — — — 

P3[3 = — — 

P3/4 — — — 

P35 _ = — 


Continued on Next Page... 


AA 


B.2. Electrical subsystem 


Table B.1 — Continued 


PSoC® port Signal Description Available at 
P3|6 = = = 

P3|7 _ = = 

P4|0 ax Accelerometer output CONNS 

P4{1 ay Accelerometer output CONNS 

P42 aZ Accelerometer output CONNS 

P43 RF_RX RF receiver data TP11 

P44 — _ — 

P45 = Potentiometer VR3 

P4|6 = Potentiometer VR2 

P4|7 a Potentiometer VRI1 

P5(0 FLT_INV1 — Fault in Inverter-1 D1 (Red LED) 
P51 FLT_INV1 — Fault in Inverter-2 D2 (Red LED) 
P5[2 TORQ_ON Motor energized D3 (Red LED) 
P5|3 WAIT In WAIT state D4 (Red LED) 
P5/4 — RS232 CONN6 

P5|5 — RS§232 CONN6 

P5|6 — RS232 CONN6 

P5|7 — RS232 CONN6 

P6|0 UH1i_ Inverter-1 PWM CONN201 
P6l1 VAL Inverter-1 PWM CONN201 
P6|2 WHii_ Inverter-1 PWM CONN201 
P63 ULI1i_ Inverter-1 PWM CONN201 
P64 VLIi_ Inverter-1 PWM CONN201 
P6|5 WLIi_ Inverter-1 PWM CONN201 
P6|6 Foli_ Inverter-1 Fault CONN201 
P6|7 — Push-button switch 55 

P12(0] UH2i_ Inverter-2 PWM CONN202 
P12{1] VH2i_ Inverter-2 PWM CONN202 
P12[2] WH2i_ Inverter-2 PWM CONN202 
P12[3] UL2i_ Inverter-2 PWM CONN202 


Continued on Next Page... 
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Table B.1 — Continued 


PSoC® port Signal Description Available at 
P12|4 VL2i_ Inverter-2 PWM CONN202 
PI215 WL2i_ Inverter-2 PWM CONN202 
P12|6 Fo2i_ Inverter-2 Fault CONN202 
P12|7 — Push-button switch S6 

P15|0 => Crystal XTAL-Y2 
P15{1 = Crystal XTAL-Y2 
PI5|2 —= Crystal XTAL-Y1 
P15[3 — Crystal XTAL-Y1 
P15|4 — Push-button switch S2 

P15[5 _ Push-button switch 53 

P15|6 = = = 

P15|7 = _ — 
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PSoC® top-level schematics (Page-3): Fault servicing, position sensing and 


PWM generation for motor-2. 


Figure B.18 
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PSoC® top-level schematics (Page-4): Timers and IDACs. 


Figure B.19 
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#tinclude <device.h> 


T/C ICICI ICICI ICICI ICICI ICICI ICICI ICICI IOI IOI ICICI III IC ICICI CI ICICI ICI ICICI ICICI ICI ICI AIC ICC AI IC ak a 2K ak 


/* Define and initialize all parameters */ 


#define VMIN 1000 // add a de offset of 1000 to avoid overflow at lower end 

#define VMAX 2500 // Dmax = (VMAX—1200)/4096 ; 1200 = 1000 (offset) + 200 (deadband) 
#define Kil 0.0045 // 0.0045 for loop_time=100us 

#define Kpl 0.03 // 0.03 for loop_time=100us 

#define Ki2 0.0045 

#define Kp2 0.03 

#define Ksync 1020 //Gain used for scaling lag between motors to get the wheg sync term 
#define ALPHA 0.6 

#define WAIT 0 

#define CALC 1 

#define BLINDFOLD_-CNT 30311 // ~32768—2457(subtract 300ms) 

#define ATHRESH 125 //112 

#define Kl 85 // 96 => max 12A (when ref=255); 88 => max 11A; 85 => max 10.6A 

#define K2 85 

#define Nl 32768 // Step—timer max value (running at 8192Hz, gives a time-period of 4s) 
#define D_IS 9 // Defines duty factor (spatial; not temporal) for pulsed torque (d-is) 


// d-is<4 (out of 8) => Regime-1 

// a_is=4 (out of 8) => Regime—2 

// 4<d-is<8 (out of 8) => Regime-—3 
// da-is>=8 (out of 8) => Regime—4/5 


TROIS ICCC ICICI ICICI ICICI ICICI ICI ICICI ICICI IOI ICICI ICICI ICICI ICI ICICI ICI ICICI ICICI ICI ICI AI ICC AI IC ak a 2K ak 


J | ORR ROO ICICI ICICI ICICI ICICI ICICI ICICI ICICI ICICI ICICI GIOIA I ICA CACC ARC cok kc cok 
/* Define and initialize global variables x*/ 
uint16 vintl=1000, vc1=1000; 


uint16 vint2=1000, vc2=1000; 

uint16 Ifb1=0, Ifblold=0, Ifb2=0, Ifb2o0ld=0; 
uint16 Ial, Ibl1; 

uint16 Ia2, Ib2; 

uintl6 11[2]={0}; 

uintl6 12[2]={0}; 


uint8 chanl=0, chan2=0; // channel selectors for AMuxes 

uint8 flag = WAIT; 

uint8 icntl=0, icnt2=0; // large—difference counters for glitch filters 
uintl6 az[2]={0}; 


J) RRO COICO ICICI ICICI ICICI ICICI ICICI ICICI ICICI ICICI ICI ICICI III ICICI ICI ICICI IC ICICI ICICI ICI CIC AIC ICICI IC ok a 2K ak 


void piconl(uint1l6 iref, uint16 ifb) 

{ 

intl6 epi; // error can go negative as well! 
uint16 vcont; 

epi = iref—ifb; // error calculation 

vintl = vintl + Kilxepi; 

// limiter for integrator 

if (vintl >= VMAX) 

vintl = VMAX; 


else 


THIS CODE IS FOR USE IN CHATUR BOARD (PSoC based controller board for the legged vehicle 


chatur) 


CE 


82 
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128 


{ 

if (vintl <= VMIN) 

vintl = VMIN; 

t 

veont = vintl + Kplxepi; 
// limiter for pi controller 
if (vcont >= VMAX) 

vel = VMAX; 

else 

{ 

if (vcont <= VMIN) 

vel = VMIN; 

else 


vel = vcont; 


} 
} 


void picon2(uintl6 iref, uint16 


{ 


intl6 epi; // error can go negative 


uint16 vcont; 


epi = iref—ifb; // error calculation 


vint2 = vint2 + Ki2xepi; 
// limiter for integrator 
if (vint2 >= VMAX) 

vint2 = VMAX; 

else 

{ 

if (vint2 <= VMIN) 

vint2 = VMIN; 

t 

veont = vint2 + Kp2xepi; 
// limiter for pi controller 
if (vcont >= VMAX) 

ve2 = VMAX; 

else 

{ 

if (vcont <= VMIN) 

vce2 = VMIN; 


else 
vce2 = vcont; 
t 
t 
void glitch-_filter1 () 
{ 
if (Ifb1>Ifblold) 
{ 
if ((Ifb1l—Ifblold)>8000) // 
{ 
icntl = icnt1+41; 
if (icnt1l <3) 
Ifb1l = Ifblold; 
t 
else 
af 
icntl = 0 
t 
t 
else 
{ 
if ((Ifblold—Ifb1)>8000) // 
{ 
icntl = icnt1+1; 
if (icntl <3) 
Ifb1 = Ifblold; 
t 
else 
{ 
icntl = 0; 
t 


as well! 
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void glitch_filter2() 


{ 


if (Ifb2>Ifb2old) 


{ 
if ((Ifb2—Ifb2old) >8000) 


{ 
icnt2 = icnt2+41; 
if (icnt2 <3) 
Ifb2 = Ifb2old; 


else 


if ((Ifb2old—Ifb2) >8000) 
{ 
icnt2 = icnt2+41; 
if (icnt2 <3) 
Ifb2 = Ifb2old; 


void main() 


{ 


TROIS ICI ICICI III ICICI ICICI ICICI IOI ICICI ICI ICICI IC ICICI I ICICI ICI ICA AIC ICC aI IC ak a 2K ak 


/* Define and initialize all variables */ 


uint8 secnol, secnolold, secnololder , secno2, secno2old, secno2older; 
// secnoxold = sector no. in previous s/w cycle 
// secnoxolder = previous sector from which present sector was arrived at 


uint8 ref, RxDataOld=0, err_cnt=0, Iref18, Ifb18, Iref28, Ifb28;// vc28, Ifb18, Ifb28, 
vint18; 

intl6 Irefl, Iref2, Ireflavg=0, Iref2avg=0; //olvc; 

int16 Ireflsync=0, Iref2sync=0; 

int8 ewsl, ews2; // error in wheg sync 

uint16 Ifblavg=0, Ifb2avg=0; 

//uintl16 mid=29492; //32768—3276 (subtract 400 ms) 

uint8 sec_change_cntl=0, sec_change_cnt2=0, step_timer8=0; // mid8=115; 

uint16 impact_cnt=0; 

uint16 step_timer=0; 


T/C ICICI ICICI ICICI ICICI ICICI ICICI ICICI ICI ICICI ICICI CII ICI ICICI IC ICI IIS I ICI CAC AIC ICC aI IC ak a 2K ak 


/* Enable UART component */ 
UART Start () ; 


/* Enable global interrupts */ 
CyGlobaliIntEnable; 


/* Enable IDACs */ 

IDAC8_0-Start(); // IDACO 
IDAC8_1-_-Start(); // IDAC1 
IDAC8_2-_-Start(); // IDAC2 
IDAC8-_3-Start(); // IDAC3 


TROIS ICCC ICI ICICI ICICI ICICI III ICICI CII ICICI ICICI OI ICICI ICICI ICI ICCC ACIS I ICI CAC AIC ICC AICI ak a 2K ak 
J) ROR ICICI ICI ICICI ICICI ICICI ICICI ICICI ICICI CII ICICI ICI ICICI ICICI ICI ICICI ICI ICA AIC ICC aI I ak CK ak 
/* Configure and enable DMAsx/ 

/* Variable declarations for DMA-I1 */ 

/* Move these variable declarations to the top of the function x«/ 

uint8 DMA_I1_Chan; 

uint8 DMA-I1_TD[1]; 


vel8, 
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/* DMA Configuration for DMA-I1 */ 
217 #define DMA I1_BYTES_PER_BURST 2 
#define DMA_I1_REQUEST_PER_BURST 1 
#define DMA-_I1_SRC_BASE (CYDEV_PERIPH_BASE) 
#define DMA-_I1_DST_BASE (CYDEV_SRAM_BASE) 
DMA_I1_Chan = DMA-_I1_Dmalnitialize (DMA_I1_BYTES_-PER_BURST, DMA_I1-REQUEST_PER_BURST, 
222 H1I16(DMA_I1_SRC_BASE) , HI16(DMA_I1_DST_BASE) ) ; 
DMA_I1_TD[0] = CyDmaTdAllocate () ; 
CyDmaTdSetConfiguration(DMA_I1_TD[0], 4, DMA-I1_TD[0], TDINC_DST_ADR) ; 
CyDmaTdSetAddress(DMA-I1-TD [0], LO16(( uint32)ADC1I1-SAR-WRKO_PTR) , LO16((uint32)I1)); 
CyDmaChSetInitialTd(DMA-_I1_Chan, DMA-I1-TD[0]) ; 
227 CyDmaChEnable(DMA-_I1_Chan, 1) ; 


/* Variable declarations for DMA-I2 »*/ 
/* Move these variable declarations to the top of the function x«/ 
uint8 DMA-_I2_Chan; 

232 uint8 DMA-_I2-TD[1]; 


/* DMA Configuration for DMA_I2 */ 
#define DMA I2.BYTES_PER_BURST 2 
#define DMA I2,.REQUEST_PER_BURST 1 
237 #define DMA-I2-SRC_BASE (CYDEV_PERIPH_BASE) 
#define DMA-I2-DST_BASE (CYDEV_SRAM_BASE) 
DMA_I2_Chan = DMA-_I2_Dmalnitialize (DMA_12_BYTES_PER_BURST, DMA_I2,-REQUEST_PER_BURST, 
HI16(DMA_I2-SRC_BASE) , HI16(DMA_I2-_DST_BASE) ) ; 
DMA-I2_TD[0] = CyDmaTdAllocate() ; 

242 CyDmaTdSetConfiguration(DMA-I2-TD[0], 4, DMA-I2-TD[0] , TD_-INC_DST_ADR) ; 
CyDmaTdSetAddress(DMA_I2-TD [0] , LO16(( uint32)ADC1I2-SAR-WRKO_PTR) , LO16((uint32)I2)); 
CyDmaChSetInitialTd (DMA-_I2-Chan, DMA-I2-TD[0]) ; 

CyDmaChEnable(DMA_I2-Chan, 1) ; 


247 /* Variable declarations for DMA_AZ */ 
/* Move these variable declarations to the top of the function x«/ 
uint8 DMA_AZ_Chan; 
uint8 DMA_AZ_TD[1]; 


252 /* DMA Configuration for DMA_AZ x/ 
#define DMA_AZ_BYTES_PER_BURST 1 
#define DMA_AZ-REQUEST_PER_BURST 1 
#define DMA_AZSRC_BASE (CYDEV_PERIPH_BASE) 
#define DMA_AZ_DST_BASE (CYDEV_SRAM_BASE) 


257 DMA_AZ_Chan = DMA_AZ_Dmalnitialize (DMA_AZ_BYTES_PER_BURST, DMA_AZ_REQUEST_PER._BURST, 
HI16(DMA_AZ_SRC_BASE) , HI16(DMA_AZ_DST_BASE) ) ; 
DMA_AZ_TD[0] = CyDmaTdAllocate () ; 


CyDmaTdSetConfiguration(DMA-AZ_TD[0], 2, DMA-AZ.TD[0], 0); 
CyDmaTdSetAddress (DMA_AZ_TD[0] , LO16((uint32)ADC_AZ_DEC_SAMP_-PTR) , LO16((uint32)az)); 
262 CyDmaChSetInitialTd (DMA_AZ_Chan, DMA_AZ_TD[0]) ; 
CyDmaChEnable(DMA_AZ_Chan, 1) ; 
J | OR ROR ROI ICICI ICICI ICICI IIIT ICICI IOI ICICI ICICI IOI ISI ICICI RIC CAC AC aR Cake 
J | OR RO ROO IIIT ICICI ICICI ICICI ICI ICICI ICIC ICICI I ICAI I ICCA AC aR Cake ok 
/* Enable ADCs «/ 
267 ADC_I1_Start () ; 
ADC_I1_IRQ_Disable() ; 
ADC-_I2-Start (); 
ADC-I2_IRQ-Disable() ; 
ADC_AZ-_Start () ; 
272 ADC_AZ_IRQ_Disable () ; 
ControlReg-SOC_Write(1); 


/* Enable PWM blocks but keep their outputs disabled */ 
PWM_U1-Start () ; 
277 PWM_V1-Start () ; 
PWM-W1-Start () ; 
PWM_U2-Start () ; 
PWM.-V2-Start () ; 
PWM_W2.Start () ; 
282 
/* Enable ISR for transition from WAIT state to CALC state */ 
ISR_1_Start (); 


CyDelayUs(750); // wait till ’things’ settle down 
287 PWM_Loop-Start(); // Start software loop timer (100us) 
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/* Get position (sector no.) from hall sensors */ 


secnolold = StatusReg_1l_Read(); // this variable stores the sector no. during the last s/w cycle 
secno2old = StatusReg-2-Read(); // this variable stores the sector no. during the last s/w cycle 
292 secnololder = secnolold; // this is the previous sector from where the present sector was 


arrived at 
secno2older = secno2old; // this is the previous sector from where the present sector was 


arrived at 


while (1) 
{ 
297 /* Place your application code here. x*/ 
if (az[0]>A_-THRESH) // check for impact 
{ 
while (flag==WAIT) 
t 
302 WAIT_STUCK_Write(1); // I’m at WAIT state 
t 


WAIT-_STUCK_Write(0); // Shift to CALC state 
impact_cnt+4; 


307 /* Read the UART data */ 
ref = UART-_ReadRxData() ; 


TROIS CIC ICICI CII ICICI ICICI ICICI CII ICICI ICICI ICICI CII IOI ICI ICI ICICI ICICI ICI ICICI ICI ICA AIC ICC aI IC ak a 2K ak 


/* Check for RF Fault to confirm reception of correct reference value */ 


312 if (ref > RxDataOld) 
{ 
if ((ref—RxDataOld) >48) 
{ 
err_cnt = err_cnt+1; 
317 if (err-cnt>1) // 1 
{ 
ref=0; 
// Glow LED at Pin RF_FLT 
RF_FLT_DR = (RF_-FLT_DR & ~RF_FLT_MASK) | ((1 << RF_FLT-SHIFT) & RF_FLT_MASK) ; 
322 } 
else 
{ 
ref=RxDataOld; 
RF_FLT_DR = (RF_FLT_DR & ~RF_FLT_MASK) | ((0 << RF_FLT_SHIFT) & RF_FLT_MASK) ; 
327 } 
t 
else 
t 
err_cnt =0; 
332 RF_FLT_DR = (RF_FLT_DR & ~“RF_FLT_MASK) | ((0 << RF_FLT_SHIFT) & RF_FLT_MASK) ; 
t 
t 
else 
{ 
337 if ((RxDataOld—-ref ) >48) 
{ 
err-cnt = err-cnt+1; 
if (err_-cnt >1) //1 
{ 
342 ref=0; 
// Glow LED at Pin RF_FLT 
RF_FLT_DR = (RF_FLT_DR & ~RF_FLT_MASK) | ((1 << RF_FLT_SHIFT) & RF_FLT_MASK) ; 
t 
else 
347 { 
ref=RxDataOld; 
RF_FLT_DR = (RF_FLT_DR & ~RF_FLT_MASK) | ((0 << RF_FLT_SHIFT) & RF_FLT_MASK) ; 
t 
t 
352 else 
{ 


err_cnt =0; 
RF_FLT_DR = (RF_FLT_DR & ~RF_FLT_MASK) | ((0 << RF_FLT_SHIFT) & RF_FLT_MASK) ; 
t 


362 


367 


372 


377 


382 


387 


392 


397 


402 


A407 


412 
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422 
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TROIS CIC ICICI ICICI ICICI ICICI ICICI ICICI ICI ICICI CII ICICI ICI ICI ICICI ICCC I ICICI ICI ICI AIC ICC aI I ak aC ak 


//ref =1400; // for use temporarily; remove when rf link is up! 


//olve = ref<<3; // open loop vc; remove during closed loop operation! 
/* Scaling the reference */ 

Irefl = refxK1; 

Iref2 = refxK2; 


if (impact_cnt==1) // first ground impact 


{ 

Timer_Step_Start(); // start step timer 

step_timer = Timer_Step_ReadCounter () ; 

sec_change-cnt1=0; // reset sector change counts for both motors 


sec_change_cnt2=0; 


} 


else // subsequent ground impacts 
{ 
//step-timer = Timer_Step_ReadCounter(); // to be used for adjusting value of ‘mid’ 
Timer_Step_WriteCounter(N1) ; 
//mid = 12288 + (step_timer>>1) + (step_timer>>3); // (1—d)*N1 + d*N2 e.g. 0.375*32768 + 


0.625*N2 
ewsl = sec_change-_-cnt2—sec_change-cnt1l; // error in wheg sync 
ews2 = sec_change_cntl—sec_change_cnt2; 


Ireflsync += Ksyncxewsl; // +/— delta torque reference for wheg sync 
Iref2sync += Ksyncxews2; 
sec_change-cnt1l=0; 
sec_change_cnt2=0; 
t 
} // impact code ends 
else 
{ 
skip_point: 
while (flag==WAIT) 


{ 

WAIT-_STUCK-_Write(1); // I’m at WAIT state 

} 

WAIT-_STUCK_Write(0); // Shift to CALC state 


/* Read the UART data */ 
ref = UART_ReadRxData() ; 


J [OR ROR ROO ICICI ICICI ICICI CII II ICICI ICICI ICICI ICICI ICICI ICICI IOI ICI I ICAI I IC CCA AC aR Ac aR ok 
/* Check for RF Fault to confirm reception of correct reference value */ 
if (ref > RxDataOld) 


{ 
if ((ref—RxDataOld) >48) 
{ 
err_cnt = err_cnt+1; 
if (err_cnt>1) // 1 
{ 
ref=0; 
// Glow LED at Pin RF_FLT 
RF_FLT_DR = (RF_FLT_-DR & ~RF_FLT_MASK) | ((1 << RF_FLT_SHIFT) & RF_FLT_MASK) ; 
t 
else 
{ 
ref=RxDataOld; 
RF_FLT_DR = (RF_FLT_DR & ~RF_FLT_MASK) | ((0 << RF_FLT_SHIFT) & RF_FLT_MASK) ; 
t 
t 
else 
{ 
err_cnt =0; 
RF_FLT_DR = (RF_FLT_DR & ~RF_FLT_MASK) | ((0 << RF_FLT_SHIFT) & RF_FLT_MASK) ; 
t 
t 
else 
{ 


if ((RxDataOld—ref) >48) 
{ 


err-cnt = err_cnt+1; 
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if (err-cnt >1) //1 


{ 
ref=0; 
A432 // Glow LED at Pin RF_FLT 
RF_FLT_DR = (RF_FLT_-DR & ~RF_FLT_MASK) | ((1 << RF_FLT_SHIFT) & RF_FLT_MASK) ; 
t 
else 
{ 
437 ref=RxDataOld; 
RF_FLT_DR = (RF_FLT_DR & ~RF_FLT_MASK) | ((0 << RF_FLT_SHIFT) & RF_FLT_MASK) ; 
t 
t 
else 
442 { 


err_cnt =0; 
RF_FLT_DR = (RF_FLT_DR & ~“RF_FLT_MASK) | ((0 << RF_FLT_SHIFT) & RF_FLT_MASK) ; 
t 

t 


447 J) RCO ICICICI CII ICICI ICICI ICICI OIC ICI ICICI ICI ICA IIS CIC ICI CAC AIC ICC aI IC ok a 2K ak 


//ref =1400; // for use temporarily; remove when RF link is up! 


//olve = ref<<3; // open loop vc; remove during closed loop operation! 


452 /* Scaling the received ref (uint8) value to get Irefs (uintl16; 4.12 format; Ibase=2A) */ 
Irefl = ref*Kl; // 96 => max 12A 
Iref2 = refx*K2; 


step-timer = Timer_-Step-ReadCounter(); 
} // end of between—impacts code 
457 
/* Wheg synchronization */ 
Irefl += Ireflsync; 
Iref2 += Iref2sync; 
462 /*x Limit Iref to 11A (25588) x*/ 
if (Irefl >= 22000) 
Irefl = 22000; 
if (Irefl <= 0) 
Irefl = 0; 
467 if (Iref2 >= 22000) 
Iref2 = 22000; 
if (Iref2 <= 0) 
Iref2 = 0; 
if (ref==0) 
472 { 
Irefl=0; 
Iref2=0; 
Ireflsync=0; 
Iref2sync=0; 
ATT } 
/* Get position (sector no.) from hall sensors */ 
secnol = StatusReg_1_Read() ; 
secno2 = StatusReg_2_Read() ; 
482 if (secnol != secnolold) 
{ 
secnololder = secnolold; // remember previous sector 
t 
if (secno2 != secno2old) 
487 { 
secno2older = secno2old; // remember previous sector 
t 
// UVAVTEEPEPPPEP EPP Per Erber Err ered rer Er rrr er Ebr er Errer pr rer brrerbbrbrrrrbrrraes 
492 // VAPTPEPEPEEPEP EPP e Pree rE rer br rer rrr rr errr er Errerprrerbr rer bbrbrbrrbrrraes 
/* Sector change count x«/ 
if (((secnolold==5) && (secnol==4)) || ((secnolold==4) && (secnol==6)) || \ 
((secnolold==6) && (secnol==2)) || ((secnolold==2) && (secnol==3)) || \ 
((secnolold==3) && (secnol==1)) || ((secnolold==1) && (secnol==5)) ) 
497 { 
sec_change-_-cnt1l+4; 
t 


if (((secno20ld==5) && (secno2==1)) || ((secno20ld==1) && (secno2==3)) || \ 


507 


512 


517 


532 


542 


552 
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((secno20ld==3) && (secno2==2)) 
((secno20ld==6) && (secno2==4)) 


((secno20ld==2) && (secno2==6)) || \ 


lI 
|| ((secno20ld==4) && (secno2==5)) ) 


{ 
sec_change_cnt2+44; 
t 
// VALPEPPEPEPPEPPP Per ber er rr renee rrr errr errr er rer er reper reper reper dere renes 
// VALPEPPEPEP PEP PP Per ber rr errr er rrr r reper rrr rr rer er reper rer er reper rrr erderges 
/*if (step_timer<mid) 
{ 
Irefl=0; 
Iref2=0; 
TORQ_ON_Write (0) ; 
t 
else 
{ 
TORQ_ON_Write(1) ; 
t*/ 
if (sec_change_cnt1>D_IS) 
{ 
Irefl=0; 
TORQ-ON_Write(0); // LED indicator for torque ON 
t 
else 
{ 
TORQ-ON_Write(1); // LED indicator for torque ON 
t 
if (sec_change_cnt2>D_IS) 
{ 
Iref2=0; 
t 


/* EMA filter Irefs */ 
Ireflavg += (Irefl—Ireflavg)>>6; 
Iref2avg += (Iref2—Iref2avg)>>6; 


Ff i es aos ae oe HH+-+++-+-H HH+-+-+-+-+- H+ t t t t t t t 
Jf AAA HH+-++-+-+-H HH+-+-+-+-+- H+ t t t t t t t 
/* 1. Rectify , level—shift , scale and filter measured currents 

2. Generate proper duty ratios using PI controller 


3. Activate PWM in appropriate phases (based on sector no.) */ 


// For motor—1 (CCW) i.e. right motor while moving forward 


switch (secnol) 


{ 


case 0x5: 


if (secnololder==1)// non—commutating current is —Ib 
{ 
Ibl = I1[1)>>4; 


Ifbl = (0x83—Ib1) *266.667; // shift and scale the sensed current 
// Note: Ib has a 3—bit zero error; hence 0x83 instead of 0x80 


t 

else// non—commutating current is la 
{ 

Ial = I1[0]>>4; 


Ifb1 = (Ial—0x82) *266.667; // shift and scale the sensed current 
// Note: Ia has a 2—bit zero error; hence 0x82 instead of 0x80 
t 
glitch_filterl(); // get rid of false glitches 
Ifblavg += (Ifbl—Ifblavg)*ALPHA; // EMA filter 
piconl(Ireflavg ,Ifblavg); // Ifblavg 
Control_Reg-W1-_Write(0); // disable W leg 
//PWM_W1.Stop () ; 
PWM-V1_WriteCompare(0); // latch V leg to N 
Control_Reg_V1_Write (1); 
//PWM-V1-Enable () ; 
PWM-U1_WriteCompare(vcl—1000); // switch U leg // ref or vcl1—1000 
Control_Reg_U1_Write(1) ; 
//PWM-U1_Enable () ; 
break; 


case 0x4: 
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if (secnololder==5)// non—commutating current is la 
{ 

Ial = 11[0]>>4; 

Ifb1 = (Ial—0x82) *266.667; // 
t 
else // 
{ 
Ial = 11[0]>>4; 

Ib1 I1({1])>>4; 

Ifbl = (Ial+Ib1—0x105 ) «266.667; 
t 
glitch_filterl(); // get glitches 
Ifblavg += (Ifbl—Ifblavg)*ALPHA; // EMA filter 
//l\fblavg 


shift and scale the sensed 


non—commutating current is —Ic 


// shift and scale the 


rid of false 


piconl(Ireflavg ,Ifblavg) ; 
Control_Reg_V1_Write (0); 
//PWML-V1-Stop() ; 
PWM_W1_WriteCompare (0) ; 
Control_Reg-W1_Write(1) ; 
//PWM_W1_Enable() ; 
PWM-U1_WriteCompare(vcl—1000); // 
Control_Reg_U1_Write(1) ; 
//PWM-U1_Enable () ; 
break; 


case Ox6: 


ref or vcl—1000 


if (secnololder==4)// non—commutating current is 
{ 

Ial = 11[0]>>4; 

Ib1 T1[1J>>4; 

Ifbl = (Ial+Ib1—0x105) *266.667; // 


shift and scale the 


else // 


non—commutating current is Ib 


bl = I1[i]J>>4; 


b1 = (Ib1—0x83) *266.667; // shift and scale the sensed 


litch_filterl(); // get rid of false glitches 
blavg += (Ifb1—Ifblavg)*ALPHA; // EMA filter 
//lfblavg 


piconl(Ireflavg ,Ifblavg) ; 
Control_Reg_U1_Write (0) ; 
//PWM-_U1-Stop() ; 
PWM_W1_WriteCompare (0) ; 
Control_Reg-W1_Write(1) ; 
//PWM_W1_Enable() ; 
PWM_V1_WriteCompare(vcl —1000) ; 
Control_Reg_-V1_Write (1); 
//PWM-V1_Enable () ; 
break; 


case 0x2: 


//ref or ve1—1000 


if (secnololder==6)// non—commutating current is Ib 
{ 

Ib1l = I1[1]>>4; 

Ifb1l (Ib1—0x83) «266.667; // 
t 
else 
{ 
Ial = I1(0]>>4; 

Ifbl = (0x82—Ial) «266.667; 
t 
glitch_filterl(); // get glitches 
Ifblavg += (Ifbl—Ifblavg)*ALPHA; // EMA filter 
//lfblavg 


shift and scale the sensed 


// non—commutating current is —la 


rid of false 


piconl(Ireflavg ,Ifblavg); 
Control_Reg-W1_Write (0) ; 
//PWM-_W1.Stop () ; 
PWM-U1_WriteCompare (0) ; 
Control_Reg_U1_Write(1); 
//PWM-U1_Enable () ; 
PWM-V1-_WriteCompare(vcl —1000) ; 
Control_Reg_V1_Write (1); 
//PWM-V1_Enable () ; 
break; 


case 0x3: 


// vef or vcel—1000 


if (secnololder==2)// non—commutating current is —la 


sensed 


sensed 


current 


current 


current 


current 


current 
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{ 

Ial = 11[0]>>4; 

Ifbl = (0x82—Ial) «266.667; 

t 

else// non—commutating current is Ic 
{ 

Ial = I1[0]>>4; 

Ibl = I1[1])>>4; 

Ifbl = (0x105—Ia1—Ib1) «266.667; 


I 


litch_filterl(); // get rid of false glitches 
blavg += (Ifb1—Ifblavg)*ALPHA; // EMA filter 


piconl(Ireflavg ,Ifblavg);//Ifblavg 

Control_Reg-V1_Write (0) ; 

//PWM-V1-Stop() ; 

PWM-U1_WriteCompare (0) ; 
Control_Reg_U1_Write(1) ; 

//PWM-U1_Enable () ; 
PWM_W1_WriteCompare(vcl—1000); // ref or vcl—1000 
Control_Reg_W1_Write(1); 

//PWM_W1_Enable() ; 


break; 
case Oxl: 
if (secnololder==3)// non—commutating current 
{ 
Ial = I1[0]>>4; 
Ibl = I1[1])>>4; 
Ifbl = (0x105—Ial—Ib1) «266.667; 
t 
else // non—commutating current is —Ib) 
{ 
Ib1l = I1[1]>>4; 
Ifbl = (0x83—-Ib1) «266.667; // shift and scale 
t 
glitch_filterl(); // get rid of false glitches 
Ifblavg += (Ifbl—Ifblavg)*ALPHA; // EMA filter 


piconl(Ireflavg ,Ifblavg);//Ifblavg 

Control_Reg_U1_Write (0); 

//PWM_U1-Stop() ; 

PWM_V1_WriteCompare (0) ; 
Control_Reg_V1_Write (1); 

//PWM-V1_Enable () ; 
PWM_W1_WriteCompare(vcl—1000); // ref or vcl—1000 
Control_Reg-W1_Write(1) ; 

//PWM_W1-Enable() ; 


break 


3 


case 0x0: 
break; 


defau 


lt: 


PWM_U1-Stop() ; 
PWML_-V1-Stop() ; 
PWM_W1-Stop() ; 


} 


the 


Ic = —(Ia+Ib) 


sensed 


// For motor—2 (CW) i.e. left motor while moving forward 


switch (secno2) 


{ 
case 0x5: 
if (secno2o0lder==4) // non—commutating current 
{ 
Ia2 = 12[0])>>4; 
Ifb2 = (0x83—Ia2) *266.667; // shift and scale 


// Note: Ia as well as Ib have a 3—bit zero error; 


se // non—commutating current is Ib 


Ib2 = I12[1]>>4; 


b2 


(Ib2—0x83) *266.667; // shift and scale 


litch_filter2(); // get rid of false glitches 


b2avg += (Ifb2-—Ifb2avg)*ALPHA; // EMA filter 


is 


the 


the 


—la 


sensed 


hence 


sensed 


current 


current 
0x83 instead of 0x80 


current 
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picon2(Iref2avg ,Ifb2avg);//Ifb2avg 
Control_Reg_W2_Write(0) ; 
//PWM_W2.Stop(); // disable W leg 
PWM_U2_WriteCompare(0); // latch V leg to N 
Control_Reg_U2_Write (1); 
//PWM-U2_Enable () ; 
PWM_-V2_WriteCompare(vc2 —1000) ; 
Control_Reg_V2_Write (1); 
//PWM-_V2_Enable () ; 


ref 


// switch U leg // 


break; 

case 0x4: 
if (secno2older==6) // non—commutating current is 
{ 
Ia2 = 12[0]>>4; 
Ib2. = 12[1]>>4; 
Ifb2 = (0x106—Ia2—Ib2) «266.667; // shift and scal 
t 
else // non—commutating current is —la 
{ 
Ia2 = 12[0]>>4; 
Ifb2 = (0x83—Ia2) «266.667; // shift and scale the 
t 
glitch_filter2(); // get rid of false glitches 
Ifb2avg += (Ifb2—Ifb2avg)*ALPHA; // EMA filter 


picon2(Iref2avg ,Ifb2avg);//Ifb2avg 
Control_Reg_V2_Write (0) ; 
//PWM-V2-Stop () ; 
PWM-U2_WriteCompare (0) ; 
Control_Reg_U2_Write(1); 
//PWM-_U2_Enable () ; 


PWM-_W2_WriteCompare(vc2—1000); // ref or vce2—1000 
Control_Reg-W2-_Write(1) ; 
//PWM_W2_Enable() ; 
break; 
case 0x6: 
if (secno2older==2)// non—commutating current is 
{ 
Ib2) = 12[1]>>4; 
Ifb2 = (0x83—-Ib2) *266.667; // shift and scale the 
// Note: Ib has a 1—bit zero error; hence Ox7F in 
t 
else // non—commutating current is Ic = —(la+Ib) 
{ 
Ia2 = 12[0]>>4; 
Ib2) = 12[1]>>4; 
Ifb2 = (0x106—Ia2—Ib2) *266.667; // shift and scal 
t 
glitch_filter2(); // get rid of false glitches 
Ifb2avg += (Ifb2—Ifb2avg)*ALPHA; // EMA filter 


picon2(Iref2avg ,Ifb2avg);//Ifb2avg 
Control_Reg_U2_Write (0); 
//PWM_U2_Stop () ; 
PWM_V2_WriteCompare (0) ; 
Control_Reg_-V2_Write (1); 
//PWM-.V2_Enable () ; 


PWM_W2_WriteCompare(vc2—1000); // ref or vce2—1000 
Control_Reg-W2_Write(1) ; 
//PWM_W2_Enable() ; 
break; 
case 0x2: 
if (secno2older==3) // non—commutating current is 
{ 
Ia2 = 12[0]>>4; 
Ifb2 = (Ia2—0x83) *266.667; // shift and scale the 
t 
else // non—commutating current is —Ib 
{ 
Ib2) = 12[1]>>4; 
Ifb2 = (0x83—Ib2) *266.667; // shift and scale the 
t 
glitch_filter2(); // get rid of false glitches 
Ifb2avg += (Ifb2—Ifb2avg)*ALPHA; // EMA filter 


or vc2—1000 


—(Ia+Ib) 


e the sensed current 


sensed current 


—Ib 


sensed current 


stead of 0x80 


e the sensed current 


la 


sensed current 


sensed current 
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picon2(Iref2avg ,Ifb2avg);//Ifb2avg 

Control_Reg_W2_Write(0) ; 

//PWM_W2.Stop () ; 

PWM_V2_WriteCompare (0) ; 
Control_Reg_-V2_Write (1); 

//PWM-.V2_Enable () ; 
PWM_U2_WriteCompare(vc2—1000); // ref or vce2—1000 
Control_Reg_U2_Write(1) ; 

//PWM-_U2_Enable () ; 
break; 


case 0x3: 


if (secno2older==1)// non—commutating current is —Ic = Ia+Ib 

{ 

Ia2 = 12[0]>>4; 

Ib2. = I2[1]>>4; 

Ifb2 = (Ila2+Ib2—0x106) *266.667; // shift and scale the sensed current 
t 

else // non—commutating current is la 

{ 

Ia2 = 12[0]>>4; 

Ifb2 = (la2—0x83) «266.667; // shift and scale the sensed current 
t 

glitch-filter2(); // get rid of false glitches 

Ifb2avg += (Ifb2—Ifb2avg)*ALPHA; // EMA filter 


picon2(Iref2avg ,Ifb2avg);//Ifb2avg 

Control_Reg_V2_Write (0) ; 

//PWM-V2-Stop () ; 
PWM_W2_WriteCompare (0) ; 
Control_Reg-W2_Write(1) ; 

//PWM_W2-Enable () ; 
PWM_U2_WriteCompare(vc2—1000); // ref or vce2—1000 
Control_Reg_U2-_Write (1); 

//PWM-_U2_Enable () ; 
break; 


case Oxl: 


if (secno2o0lder==5)// non—commutating current is Ib 

{ 

Ib2. = I2[1]>>4; 

Ifb2 = (Ib2—0x83) *266.667; // shift and scale the sensed current 
t 

else // non—commutating current is —Ic 

{ 

Ia2 = 12[0]>>4; 

Ib2. = I2[1]>>4; 


Ifb2 = (Ila2+Ib2—0x106) *266.667; // shift and scale the sensed current 
t 
glitch_filter2(); // get rid of false glitches 
Ifb2avg += (Ifb2—Ifb2avg)*ALPHA; // EMA filter 
picon2(Iref2avg ,Ifb2avg);//Ifb2avg 

Control_Reg_U2_Write (0); 

//PWM_U2_Stop () ; 

PWM_W2_WriteCompare (0) ; 
Control_Reg-W2_Write(1) ; 

//PWM_W2-Enable() ; 
PWM_V2_WriteCompare(vc2—1000); // ref or vce2—1000 
Control_Reg_V2_Write(1); 

//PWM-_V2_Enable () ; 
break; 

case 0x0: 

break; 

default: 

PWM_U2-Stop() ; 

PWM-V2-Stop () ; 
PWM_W2-Stop () ; 


i 


~™MN 
~™N 


/* Send debug waveforms to IDACs (For Diagnostics) */ 
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/* 


//vint18 = (vintl —1000)>>4; 
//vc18=(vel —1000)>>4; 
Ifb18=Ifb1 >>8; //Use >>8 normally; Use >>4 when checking zero offset error 
//fb28=Ifb2avg >>8; 
Iref18 = Ireflavg >>8; 
//lref28 = Iref2avg >>8; 
//step_timer8 = step_timer >>8; 
//mid8 = mid>>8; 
//\al=11[0] > >4; 
IDAC8_0_SetValue(secnol*40); // secno1*40 
IDAC8_1_SetValue(az[0]); // 8uA*1*40*2.2k = 0.7V (for sec no.1) 
IDAC8_2_SetValue(Iref18);//Iref18 , vcl8, vc28 
IDAC8_3_SetValue(Ifb18); //Ifb28, step_timer8 


// CGAAAGAAAGAAAAAAGAAGAGAAAAAAGAGAAGGAGAAGGAGAAGAAGAAGAAGGAGAAGAAGGAGAAGAAGAAG@aGaa@ 
/* Save history */ 

RxDataOld = ref; 

Ifblold = Ifbl; 

Ifb2o0ld = Ifb2; 

secnolold = secnol; 


secno2old = secno2; 


// CGAAAGAAGAAGAAGAAGAAGAGGAAGAGGAGAAGGAAAAGAAGGAGGAGAAGGAGAAGAAGGAGAAGAAGAAGA@aG@ 


if (step_timer >BLINDFOLD_CNT) 


{ 
flag = WAIT; // Done with calculations 
goto skip_point; 


} 


flag = WAIT; // Done with calculations 
} // while(1) loop ends 


} // main() function ends 


[] END OF FILE «/ 


Listing B.2: C-code for the control algorithm that is executed by PSoC®’s ARM core. 
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Appendix C 


List of Publications 


1. Lalit Patnaik and Loganathan Umanand, “Torque regimes in a rimless wheel based 
2D dynamic walker using pulsed torque actuation,” under review, [EEE Transac- 


tions on Robotics. 


2. Lalit Patnaik and Loganathan Umanand, “A control topology for pulsed torque ac- 
tuation of a synchronized dual BLDC motor driven platform with cyclically varying 


load torque,” under review, JET Power Electronics. 


3. Lalit Patnaik and Loganathan Umanand, “Modeling of constraints, fundamental 
limits and optimal locus of operating points in velocity-angle space for an in- 
verted pendulum based actuated dynamic walker,” manuscript submitted, S%m- 


ulation Modelling Practice and Theory. 


4. Lalit Patnaik and Loganathan Umanand, “A dynamic model for the Jansen leg 


” 


mechanism using bondgraphs,” manuscript under preparation. 
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